Initial commit

README.md

@@ -0,0 +1,8 @@
+# Arduino AVR Boards
+
+[![Check Arduino status](https://github.com/arduino/ArduinoCore-avr/actions/workflows/check-arduino.yml/badge.svg)](https://github.com/arduino/ArduinoCore-avr/actions/workflows/check-arduino.yml)
+[![Compile Examples status](https://github.com/arduino/ArduinoCore-avr/actions/workflows/compile-platform-examples.yml/badge.svg)](https://github.com/arduino/ArduinoCore-avr/actions/workflows/compile-platform-examples.yml)
+[![Spell Check status](https://github.com/arduino/ArduinoCore-avr/actions/workflows/spell-check.yml/badge.svg)](https://github.com/arduino/ArduinoCore-avr/actions/workflows/spell-check.yml)
+
+This repository contains the source code and configuration files of the Arduino AVR Boards
+[platform](https://arduino.github.io/arduino-cli/latest/platform-specification/).

boards.txt

@@ -0,0 +1,81 @@
+# See: https://arduino.github.io/arduino-cli/latest/platform-specification/
+
+menu.cpu=Processor
+
+##############################################################
+
+mega.name=idiBus Master
+
+mega.vid.0=0x2341
+mega.pid.0=0x0010
+mega.vid.1=0x2341
+mega.pid.1=0x0042
+mega.vid.2=0x2A03
+mega.pid.2=0x0010
+mega.vid.3=0x2A03
+mega.pid.3=0x0042
+mega.vid.4=0x2341
+mega.pid.4=0x0210
+mega.vid.5=0x2341
+mega.pid.5=0x0242
+mega.upload_port.0.vid=0x2341
+mega.upload_port.0.pid=0x0010
+mega.upload_port.1.vid=0x2341
+mega.upload_port.1.pid=0x0042
+mega.upload_port.2.vid=0x2A03
+mega.upload_port.2.pid=0x0010
+mega.upload_port.3.vid=0x2A03
+mega.upload_port.3.pid=0x0042
+mega.upload_port.4.vid=0x2341
+mega.upload_port.4.pid=0x0210
+mega.upload_port.5.vid=0x2341
+mega.upload_port.5.pid=0x0242
+mega.upload_port.6.board=mega
+
+mega.upload.tool=arduino:avrdude
+mega.upload.tool.default=avrdude
+mega.upload.maximum_data_size=8192
+
+mega.bootloader.tool=arduino:avrdude
+mega.bootloader.tool.default=avrdude
+mega.bootloader.low_fuses=0xFF
+mega.bootloader.unlock_bits=0x3F
+mega.bootloader.lock_bits=0xFF
+
+mega.build.f_cpu=16000000L
+mega.build.variant=mega
+mega.build.core=arduino:arduino
+# default board may be overridden by the cpu menu
+mega.build.board=AVR_MEGA2560
+
+## Arduino Mega w/ ATmega2560
+## -------------------------
+mega.menu.cpu.atmega2560=ATmega2560 (Mega 2560)
+
+mega.menu.cpu.atmega2560.upload.protocol=wiring
+mega.menu.cpu.atmega2560.upload.maximum_size=253952
+mega.menu.cpu.atmega2560.upload.speed=115200
+
+mega.menu.cpu.atmega2560.bootloader.high_fuses=0xD0
+mega.menu.cpu.atmega2560.bootloader.extended_fuses=0xFD
+mega.menu.cpu.atmega2560.bootloader.file=stk500v2/stk500boot_v2_mega2560.hex
+
+mega.menu.cpu.atmega2560.build.mcu=atmega2560
+mega.menu.cpu.atmega2560.build.board=AVR_MEGA2560
+
+## Arduino Mega w/ ATmega1280
+## -------------------------
+mega.menu.cpu.atmega1280=ATmega1280
+
+mega.menu.cpu.atmega1280.upload.protocol=arduino
+mega.menu.cpu.atmega1280.upload.maximum_size=126976
+mega.menu.cpu.atmega1280.upload.speed=57600
+
+mega.menu.cpu.atmega1280.bootloader.high_fuses=0xDA
+mega.menu.cpu.atmega1280.bootloader.extended_fuses=0xF5
+mega.menu.cpu.atmega1280.bootloader.file=atmega/ATmegaBOOT_168_atmega1280.hex
+
+mega.menu.cpu.atmega1280.build.mcu=atmega1280
+mega.menu.cpu.atmega1280.build.board=AVR_MEGA
+
+##############################################################

bootloaders/stk500v2/License.txt

@@ -0,0 +1,280 @@
+		    GNU GENERAL PUBLIC LICENSE
+		       Version 2, June 1991
+
+ Copyright (C) 1989, 1991 Free Software Foundation, Inc.
+                 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA
+ Everyone is permitted to copy and distribute verbatim copies
+ of this license document, but changing it is not allowed.
+
+			    Preamble
+
+  The licenses for most software are designed to take away your
+freedom to share and change it.  By contrast, the GNU General Public
+License is intended to guarantee your freedom to share and change free
+software--to make sure the software is free for all its users.  This
+General Public License applies to most of the Free Software
+Foundation's software and to any other program whose authors commit to
+using it.  (Some other Free Software Foundation software is covered by
+the GNU Library General Public License instead.)  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
+this service 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 make restrictions that forbid
+anyone to deny you these rights or to ask you to surrender the rights.
+These restrictions translate to certain responsibilities for you if you
+distribute copies of the software, or if you modify it.
+
+  For example, if you distribute copies of such a program, whether
+gratis or for a fee, you must give the recipients all the rights that
+you have.  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.
+
+  We protect your rights with two steps: (1) copyright the software, and
+(2) offer you this license which gives you legal permission to copy,
+distribute and/or modify the software.
+
+  Also, for each author's protection and ours, we want to make certain
+that everyone understands that there is no warranty for this free
+software.  If the software is modified by someone else and passed on, we
+want its recipients to know that what they have is not the original, so
+that any problems introduced by others will not reflect on the original
+authors' reputations.
+
+  Finally, any free program is threatened constantly by software
+patents.  We wish to avoid the danger that redistributors of a free
+program will individually obtain patent licenses, in effect making the
+program proprietary.  To prevent this, we have made it clear that any
+patent must be licensed for everyone's free use or not licensed at all.
+
+  The precise terms and conditions for copying, distribution and
+modification follow.
+
+		    GNU GENERAL PUBLIC LICENSE
+   TERMS AND CONDITIONS FOR COPYING, DISTRIBUTION AND MODIFICATION
+
+  0. This License applies to any program or other work which contains
+a notice placed by the copyright holder saying it may be distributed
+under the terms of this General Public License.  The "Program", below,
+refers to any such program or work, and a "work based on the Program"
+means either the Program or any derivative work under copyright law:
+that is to say, a work containing the Program or a portion of it,
+either verbatim or with modifications and/or translated into another
+language.  (Hereinafter, translation is included without limitation in
+the term "modification".)  Each licensee is addressed as "you".
+
+Activities other than copying, distribution and modification are not
+covered by this License; they are outside its scope.  The act of
+running the Program is not restricted, and the output from the Program
+is covered only if its contents constitute a work based on the
+Program (independent of having been made by running the Program).
+Whether that is true depends on what the Program does.
+
+  1. You may copy and distribute 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 and disclaimer of warranty; keep intact all the
+notices that refer to this License and to the absence of any warranty;
+and give any other recipients of the Program a copy of this License
+along with the Program.
+
+You may charge a fee for the physical act of transferring a copy, and
+you may at your option offer warranty protection in exchange for a fee.
+
+  2. You may modify your copy or copies of the Program or any portion
+of it, thus forming a work based on the Program, and copy and
+distribute such modifications or work under the terms of Section 1
+above, provided that you also meet all of these conditions:
+
+    a) You must cause the modified files to carry prominent notices
+    stating that you changed the files and the date of any change.
+
+    b) You must cause any work that you distribute or publish, that in
+    whole or in part contains or is derived from the Program or any
+    part thereof, to be licensed as a whole at no charge to all third
+    parties under the terms of this License.
+
+    c) If the modified program normally reads commands interactively
+    when run, you must cause it, when started running for such
+    interactive use in the most ordinary way, to print or display an
+    announcement including an appropriate copyright notice and a
+    notice that there is no warranty (or else, saying that you provide
+    a warranty) and that users may redistribute the program under
+    these conditions, and telling the user how to view a copy of this
+    License.  (Exception: if the Program itself is interactive but
+    does not normally print such an announcement, your work based on
+    the Program is not required to print an announcement.)
+
+These requirements apply to the modified work as a whole.  If
+identifiable sections of that work are not derived from the Program,
+and can be reasonably considered independent and separate works in
+themselves, then this License, and its terms, do not apply to those
+sections when you distribute them as separate works.  But when you
+distribute the same sections as part of a whole which is a work based
+on the Program, the distribution of the whole must be on the terms of
+this License, whose permissions for other licensees extend to the
+entire whole, and thus to each and every part regardless of who wrote it.
+
+Thus, it is not the intent of this section to claim rights or contest
+your rights to work written entirely by you; rather, the intent is to
+exercise the right to control the distribution of derivative or
+collective works based on the Program.
+
+In addition, mere aggregation of another work not based on the Program
+with the Program (or with a work based on the Program) on a volume of
+a storage or distribution medium does not bring the other work under
+the scope of this License.
+
+  3. You may copy and distribute the Program (or a work based on it,
+under Section 2) in object code or executable form under the terms of
+Sections 1 and 2 above provided that you also do one of the following:
+
+    a) Accompany it with the complete corresponding machine-readable
+    source code, which must be distributed under the terms of Sections
+    1 and 2 above on a medium customarily used for software interchange; or,
+
+    b) Accompany it with a written offer, valid for at least three
+    years, to give any third party, for a charge no more than your
+    cost of physically performing source distribution, a complete
+    machine-readable copy of the corresponding source code, to be
+    distributed under the terms of Sections 1 and 2 above on a medium
+    customarily used for software interchange; or,
+
+    c) Accompany it with the information you received as to the offer
+    to distribute corresponding source code.  (This alternative is
+    allowed only for noncommercial distribution and only if you
+    received the program in object code or executable form with such
+    an offer, in accord with Subsection b above.)
+
+The source code for a work means the preferred form of the work for
+making modifications to it.  For an executable work, complete source
+code means all the source code for all modules it contains, plus any
+associated interface definition files, plus the scripts used to
+control compilation and installation of the executable.  However, as a
+special exception, the source code distributed need not include
+anything that is normally distributed (in either source or binary
+form) with the major components (compiler, kernel, and so on) of the
+operating system on which the executable runs, unless that component
+itself accompanies the executable.
+
+If distribution of executable or object code is made by offering
+access to copy from a designated place, then offering equivalent
+access to copy the source code from the same place counts as
+distribution of the source code, even though third parties are not
+compelled to copy the source along with the object code.
+
+  4. You may not copy, modify, sublicense, or distribute the Program
+except as expressly provided under this License.  Any attempt
+otherwise to copy, modify, sublicense or distribute the Program is
+void, and will automatically terminate your rights under this License.
+However, parties who have received copies, or rights, from you under
+this License will not have their licenses terminated so long as such
+parties remain in full compliance.
+
+  5. You are not required to accept this License, since you have not
+signed it.  However, nothing else grants you permission to modify or
+distribute the Program or its derivative works.  These actions are
+prohibited by law if you do not accept this License.  Therefore, by
+modifying or distributing the Program (or any work based on the
+Program), you indicate your acceptance of this License to do so, and
+all its terms and conditions for copying, distributing or modifying
+the Program or works based on it.
+
+  6. Each time you redistribute the Program (or any work based on the
+Program), the recipient automatically receives a license from the
+original licensor to copy, distribute or modify the Program subject to
+these terms and conditions.  You may not impose any further
+restrictions on the recipients' exercise of the rights granted herein.
+You are not responsible for enforcing compliance by third parties to
+this License.
+
+  7. If, as a consequence of a court judgment or allegation of patent
+infringement or for any other reason (not limited to patent issues),
+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
+distribute so as to satisfy simultaneously your obligations under this
+License and any other pertinent obligations, then as a consequence you
+may not distribute the Program at all.  For example, if a patent
+license would not permit royalty-free redistribution of the Program by
+all those who receive copies directly or indirectly through you, then
+the only way you could satisfy both it and this License would be to
+refrain entirely from distribution of the Program.
+
+If any portion of this section is held invalid or unenforceable under
+any particular circumstance, the balance of the section is intended to
+apply and the section as a whole is intended to apply in other
+circumstances.
+
+It is not the purpose of this section to induce you to infringe any
+patents or other property right claims or to contest validity of any
+such claims; this section has the sole purpose of protecting the
+integrity of the free software distribution system, which is
+implemented by public license practices.  Many people have made
+generous contributions to the wide range of software distributed
+through that system in reliance on consistent application of that
+system; it is up to the author/donor to decide if he or she is willing
+to distribute software through any other system and a licensee cannot
+impose that choice.
+
+This section is intended to make thoroughly clear what is believed to
+be a consequence of the rest of this License.
+
+  8. If the distribution and/or use of the Program is restricted in
+certain countries either by patents or by copyrighted interfaces, the
+original copyright holder who places the Program under this License
+may add an explicit geographical distribution limitation excluding
+those countries, so that distribution is permitted only in or among
+countries not thus excluded.  In such case, this License incorporates
+the limitation as if written in the body of this License.
+
+  9. The Free Software Foundation may publish revised and/or new versions
+of the 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 a version number of this License which applies to it and "any
+later version", you have the option of following the terms and conditions
+either of that version or of any later version published by the Free
+Software Foundation.  If the Program does not specify a version number of
+this License, you may choose any version ever published by the Free Software
+Foundation.
+
+  10. If you wish to incorporate parts of the Program into other free
+programs whose distribution conditions are different, write to the author
+to ask for permission.  For software which is copyrighted by the Free
+Software Foundation, write to the Free Software Foundation; we sometimes
+make exceptions for this.  Our decision will be guided by the two goals
+of preserving the free status of all derivatives of our free software and
+of promoting the sharing and reuse of software generally.
+
+			    NO WARRANTY
+
+  11. BECAUSE THE PROGRAM IS LICENSED FREE OF CHARGE, 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.
+
+  12. IN NO EVENT UNLESS REQUIRED BY APPLICABLE LAW OR AGREED TO IN WRITING
+WILL ANY COPYRIGHT HOLDER, OR ANY OTHER PARTY WHO MAY MODIFY AND/OR
+REDISTRIBUTE 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.
+
+		     END OF TERMS AND CONDITIONS

bootloaders/stk500v2/Makefile

@@ -0,0 +1,127 @@
+################################################################################
+# Automatically-generated file. Do not edit!
+################################################################################
+
+SHELL := cmd.exe
+RM := rm -rf
+
+USER_OBJS :=
+
+LIBS := 
+PROJ := 
+
+O_SRCS := 
+C_SRCS := 
+S_SRCS := 
+S_UPPER_SRCS := 
+OBJ_SRCS := 
+ASM_SRCS := 
+PREPROCESSING_SRCS := 
+OBJS := 
+OBJS_AS_ARGS := 
+C_DEPS := 
+C_DEPS_AS_ARGS := 
+EXECUTABLES := 
+OUTPUT_FILE_PATH :=
+OUTPUT_FILE_PATH_AS_ARGS :=
+AVR_APP_PATH :=$$$AVR_APP_PATH$$$
+QUOTE := "
+ADDITIONAL_DEPENDENCIES:=
+OUTPUT_FILE_DEP:=
+LIB_DEP:=
+LINKER_SCRIPT_DEP:=
+
+# Every subdirectory with source files must be described here
+SUBDIRS := 
+
+
+# Add inputs and outputs from these tool invocations to the build variables 
+C_SRCS +=  \
+../stk500boot.c
+
+
+PREPROCESSING_SRCS += 
+
+
+ASM_SRCS += 
+
+
+OBJS +=  \
+stk500boot.o
+
+OBJS_AS_ARGS +=  \
+stk500boot.o
+
+C_DEPS +=  \
+stk500boot.d
+
+C_DEPS_AS_ARGS +=  \
+stk500boot.d
+
+OUTPUT_FILE_PATH +=stk500boot_v2_mega2560.elf
+
+OUTPUT_FILE_PATH_AS_ARGS +=stk500boot_v2_mega2560.elf
+
+ADDITIONAL_DEPENDENCIES:=
+
+OUTPUT_FILE_DEP:= ./makedep.mk
+
+LIB_DEP+= 
+
+LINKER_SCRIPT_DEP+= 
+
+
+# AVR32/GNU C Compiler
+./stk500boot.o: .././stk500boot.c
+	@echo Building file: $<
+	@echo Invoking: AVR/GNU C Compiler : 5.4.0
+	$(QUOTE)C:\Program Files (x86)\Atmel\Studio\7.0\toolchain\avr8\avr8-gnu-toolchain\bin\avr-gcc.exe$(QUOTE)  -x c -funsigned-char -funsigned-bitfields -DDEBUG -DF_CPU=16000000UL  -I"C:\Program Files (x86)\Atmel\Studio\7.0\Packs\Atmel\ATmega_DFP\1.7.374\include"  -Os -ffunction-sections -fdata-sections -fpack-struct -fshort-enums -mrelax -g2 -Wall -mmcu=atmega2560 -B "C:\Program Files (x86)\Atmel\Studio\7.0\Packs\Atmel\ATmega_DFP\1.7.374\gcc\dev\atmega2560" -c -std=gnu99 -MD -MP -MF "$(@:%.o=%.d)" -MT"$(@:%.o=%.d)" -MT"$(@:%.o=%.o)"   -o "$@" "$<" 
+	@echo Finished building: $<
+	
+
+
+
+
+# AVR32/GNU Preprocessing Assembler
+
+
+
+# AVR32/GNU Assembler
+
+
+
+
+ifneq ($(MAKECMDGOALS),clean)
+ifneq ($(strip $(C_DEPS)),)
+-include $(C_DEPS)
+endif
+endif
+
+# Add inputs and outputs from these tool invocations to the build variables 
+
+# All Target
+all: $(OUTPUT_FILE_PATH) $(ADDITIONAL_DEPENDENCIES)
+
+$(OUTPUT_FILE_PATH): $(OBJS) $(USER_OBJS) $(OUTPUT_FILE_DEP) $(LIB_DEP) $(LINKER_SCRIPT_DEP)
+	@echo Building target: $@
+	@echo Invoking: AVR/GNU Linker : 5.4.0
+	$(QUOTE)C:\Program Files (x86)\Atmel\Studio\7.0\toolchain\avr8\avr8-gnu-toolchain\bin\avr-gcc.exe$(QUOTE) -o$(OUTPUT_FILE_PATH_AS_ARGS) $(OBJS_AS_ARGS) $(USER_OBJS) $(LIBS) -Wl,-Map="stk500boot_v2_mega2560.map" -Wl,--start-group -Wl,-lm  -Wl,--end-group -Wl,--gc-sections -mrelax -Wl,-section-start=.text=3e000  -mmcu=atmega2560 -B "C:\Program Files (x86)\Atmel\Studio\7.0\Packs\Atmel\ATmega_DFP\1.7.374\gcc\dev\atmega2560"  
+	@echo Finished building target: $@
+	"C:\Program Files (x86)\Atmel\Studio\7.0\toolchain\avr8\avr8-gnu-toolchain\bin\avr-objcopy.exe" -O ihex -R .eeprom -R .fuse -R .lock -R .signature -R .user_signatures  "stk500boot_v2_mega2560.elf" "stk500boot_v2_mega2560.hex"
+	"C:\Program Files (x86)\Atmel\Studio\7.0\toolchain\avr8\avr8-gnu-toolchain\bin\avr-objcopy.exe" -j .eeprom  --set-section-flags=.eeprom=alloc,load --change-section-lma .eeprom=0  --no-change-warnings -O ihex "stk500boot_v2_mega2560.elf" "stk500boot_v2_mega2560.eep" || exit 0
+	"C:\Program Files (x86)\Atmel\Studio\7.0\toolchain\avr8\avr8-gnu-toolchain\bin\avr-objdump.exe" -h -S "stk500boot_v2_mega2560.elf" > "stk500boot_v2_mega2560.lss"
+	"C:\Program Files (x86)\Atmel\Studio\7.0\toolchain\avr8\avr8-gnu-toolchain\bin\avr-objcopy.exe" -O srec -R .eeprom -R .fuse -R .lock -R .signature -R .user_signatures "stk500boot_v2_mega2560.elf" "stk500boot_v2_mega2560.srec"
+	"C:\Program Files (x86)\Atmel\Studio\7.0\toolchain\avr8\avr8-gnu-toolchain\bin\avr-size.exe" "stk500boot_v2_mega2560.elf"
+	
+	
+
+
+
+
+
+# Other Targets
+clean:
+	-$(RM) $(OBJS_AS_ARGS) $(EXECUTABLES)  
+	-$(RM) $(C_DEPS_AS_ARGS)   
+	rm -rf "stk500boot_v2_mega2560.elf" "stk500boot_v2_mega2560.a" "stk500boot_v2_mega2560.hex" "stk500boot_v2_mega2560.lss" "stk500boot_v2_mega2560.eep" "stk500boot_v2_mega2560.map" "stk500boot_v2_mega2560.srec" "stk500boot_v2_mega2560.usersignatures"
+	

bootloaders/stk500v2/avr_cpunames.h

@@ -0,0 +1,189 @@
+//**************************************************************************************************
+//*
+//*	Atmel AVR CPU name strings
+//*
+//**************************************************************************************************
+//*	Sep 19,	2010	<MLS> Started on avr_cpunames.h
+//**************************************************************************************************
+
+//#include	"avr_cpunames.h"
+
+//**************************************************************************************************
+
+
+#if defined (__AVR_AT94K__)
+									#define	_AVR_CPU_NAME_	"AT94k"
+#elif defined (__AVR_AT43USB320__)
+#elif defined (__AVR_AT43USB355__)
+#elif defined (__AVR_AT76C711__)
+#elif defined (__AVR_AT86RF401__)
+#elif defined (__AVR_AT90PWM1__)
+#elif defined (__AVR_AT90PWM2__)
+#elif defined (__AVR_AT90PWM2B__)
+#elif defined (__AVR_AT90PWM3__)
+#elif defined (__AVR_AT90PWM3B__)
+#elif defined (__AVR_AT90PWM216__)
+#elif defined (__AVR_AT90PWM316__)
+#elif defined (__AVR_ATmega32C1__)
+#elif defined (__AVR_ATmega32M1__)
+#elif defined (__AVR_ATmega32U4__)
+									#define	_AVR_CPU_NAME_	"ATmega32U4"
+#elif defined (__AVR_ATmega32U6__)
+									#define	_AVR_CPU_NAME_	"ATmega32U6"
+#elif defined (__AVR_ATmega128__)
+									#define	_AVR_CPU_NAME_	"Atmega128"
+#elif defined (__AVR_ATmega1280__)
+									#define	_AVR_CPU_NAME_	"ATmega1280"
+#elif defined (__AVR_ATmega1281__)
+									#define	_AVR_CPU_NAME_	"ATmega1281"
+#elif defined (__AVR_ATmega1284P__)
+									#define	_AVR_CPU_NAME_	"ATmega1284"
+#elif defined (__AVR_ATmega128RFA1__)
+									#define	_AVR_CPU_NAME_	"ATmega128RFA1"
+#elif defined (__AVR_ATmega2560__)
+									#define	_AVR_CPU_NAME_	"ATmega2560"
+#elif defined (__AVR_ATmega2561__)
+									#define	_AVR_CPU_NAME_	"ATmega2561"
+#elif defined (__AVR_AT90CAN32__)
+									#define	_AVR_CPU_NAME_	"AT90CAN32"
+#elif defined (__AVR_AT90CAN64__)
+									#define	_AVR_CPU_NAME_	"AT90CAN64"
+#elif defined (__AVR_AT90CAN128__)
+									#define	_AVR_CPU_NAME_	"AT90CAN128"
+#elif defined (__AVR_AT90USB82__)
+									#define	_AVR_CPU_NAME_	"AT90USB82"
+#elif defined (__AVR_AT90USB162__)
+									#define	_AVR_CPU_NAME_	"AT90USB162"
+#elif defined (__AVR_AT90USB646__)
+									#define	_AVR_CPU_NAME_	"AT90USB646"
+#elif defined (__AVR_AT90USB647__)
+									#define	_AVR_CPU_NAME_	"AT90USB647"
+#elif defined (__AVR_AT90USB1286__)
+									#define	_AVR_CPU_NAME_	"AT90USB1286"
+#elif defined (__AVR_AT90USB1287__)
+									#define	_AVR_CPU_NAME_	"AT90USB1287"
+#elif defined (__AVR_ATmega64__)
+									#define	_AVR_CPU_NAME_	"ATmega64"
+#elif defined (__AVR_ATmega640__)
+									#define	_AVR_CPU_NAME_	"ATmega640"
+#elif defined (__AVR_ATmega644__)
+									#define	_AVR_CPU_NAME_	"ATmega644"
+#elif defined (__AVR_ATmega644P__)
+									#define	_AVR_CPU_NAME_	"ATmega644P"
+#elif defined (__AVR_ATmega645__)
+									#define	_AVR_CPU_NAME_	"ATmega645"
+#elif defined (__AVR_ATmega6450__)
+									#define	_AVR_CPU_NAME_	"ATmega6450"
+#elif defined (__AVR_ATmega649__)
+									#define	_AVR_CPU_NAME_	"ATmega649"
+#elif defined (__AVR_ATmega6490__)
+									#define	_AVR_CPU_NAME_	"ATmega6490"
+#elif defined (__AVR_ATmega103__)
+									#define	_AVR_CPU_NAME_	"ATmega103"
+#elif defined (__AVR_ATmega32__)
+									#define	_AVR_CPU_NAME_	"Atmega32"
+#elif defined (__AVR_ATmega323__)
+									#define	_AVR_CPU_NAME_	"ATmega323"
+#elif defined (__AVR_ATmega324P__)
+									#define	_AVR_CPU_NAME_	"ATmega324P"
+#elif defined (__AVR_ATmega325__)
+									#define	_AVR_CPU_NAME_	"ATmega325"
+#elif defined (__AVR_ATmega325P__)
+									#define	_AVR_CPU_NAME_	"ATmega325P"
+#elif defined (__AVR_ATmega3250__)
+									#define	_AVR_CPU_NAME_	"ATmega3250"
+#elif defined (__AVR_ATmega3250P__)
+									#define	_AVR_CPU_NAME_	"ATmega3250P"
+#elif defined (__AVR_ATmega328P__)
+									#define	_AVR_CPU_NAME_	"ATmega328P"
+#elif defined (__AVR_ATmega329__)
+									#define	_AVR_CPU_NAME_	"ATmega329"
+#elif defined (__AVR_ATmega329P__)
+									#define	_AVR_CPU_NAME_	"ATmega329P"
+#elif defined (__AVR_ATmega3290__)
+									#define	_AVR_CPU_NAME_	"ATmega3290"
+#elif defined (__AVR_ATmega3290P__)
+									#define	_AVR_CPU_NAME_	"ATmega3290P"
+#elif defined (__AVR_ATmega32HVB__)
+									#define	_AVR_CPU_NAME_	"ATmega32HVB"
+#elif defined (__AVR_ATmega406__)
+									#define	_AVR_CPU_NAME_	"ATmega406"
+#elif defined (__AVR_ATmega16__)
+									#define	_AVR_CPU_NAME_	"Atmega16"
+#elif defined (__AVR_ATmega161__)
+									#define	_AVR_CPU_NAME_	"ATmega161"
+#elif defined (__AVR_ATmega162__)
+									#define	_AVR_CPU_NAME_	"ATmega162"
+#elif defined (__AVR_ATmega163__)
+									#define	_AVR_CPU_NAME_	"ATmega163"
+#elif defined (__AVR_ATmega164P__)
+									#define	_AVR_CPU_NAME_	"ATmega164P"
+#elif defined (__AVR_ATmega165__)
+									#define	_AVR_CPU_NAME_	"ATmega165"
+#elif defined (__AVR_ATmega165P__)
+									#define	_AVR_CPU_NAME_	"ATmega165P"
+#elif defined (__AVR_ATmega168__)
+									#define	_AVR_CPU_NAME_	"ATmega168"
+#elif defined (__AVR_ATmega168P__)
+									#define	_AVR_CPU_NAME_	"ATmega168P"
+#elif defined (__AVR_ATmega169__)
+									#define	_AVR_CPU_NAME_	"Atmega169"
+#elif defined (__AVR_ATmega169P__)
+									#define	_AVR_CPU_NAME_	"ATmega169P"
+#elif defined (__AVR_ATmega8HVA__)
+									#define	_AVR_CPU_NAME_	"ATmega8HVA"
+#elif defined (__AVR_ATmega16HVA__)
+									#define	_AVR_CPU_NAME_	"ATmega16HVA"
+#elif defined (__AVR_ATmega8__)
+									#define	_AVR_CPU_NAME_	"ATmega8"
+#elif defined (__AVR_ATmega48__)
+									#define	_AVR_CPU_NAME_	"ATmega48"
+#elif defined (__AVR_ATmega48P__)
+									#define	_AVR_CPU_NAME_	"ATmega48P"
+#elif defined (__AVR_ATmega88__)
+									#define	_AVR_CPU_NAME_	"ATmega88"
+#elif defined (__AVR_ATmega88P__)
+									#define	_AVR_CPU_NAME_	"ATmega88P"
+#elif defined (__AVR_ATmega8515__)
+									#define	_AVR_CPU_NAME_	"ATmega8515"
+#elif defined (__AVR_ATmega8535__)
+									#define	_AVR_CPU_NAME_	"ATmega8535"
+#elif defined (__AVR_AT90S8535__)
+#elif defined (__AVR_AT90C8534__)
+#elif defined (__AVR_AT90S8515__)
+#elif defined (__AVR_AT90S4434__)
+#elif defined (__AVR_AT90S4433__)
+#elif defined (__AVR_AT90S4414__)
+#elif defined (__AVR_ATtiny22__)
+#elif defined (__AVR_ATtiny26__)
+#elif defined (__AVR_AT90S2343__)
+#elif defined (__AVR_AT90S2333__)
+#elif defined (__AVR_AT90S2323__)
+#elif defined (__AVR_AT90S2313__)
+#elif defined (__AVR_ATtiny2313__)
+									#define	_AVR_CPU_NAME_	"ATtiny2313"
+#elif defined (__AVR_ATtiny13__)
+#elif defined (__AVR_ATtiny13A__)
+#elif defined (__AVR_ATtiny25__)
+#elif defined (__AVR_ATtiny45__)
+#elif defined (__AVR_ATtiny85__)
+#elif defined (__AVR_ATtiny24__)
+#elif defined (__AVR_ATtiny44__)
+#elif defined (__AVR_ATtiny84__)
+#elif defined (__AVR_ATtiny261__)
+#elif defined (__AVR_ATtiny461__)
+#elif defined (__AVR_ATtiny861__)
+#elif defined (__AVR_ATtiny43U__)
+#elif defined (__AVR_ATtiny48__)
+#elif defined (__AVR_ATtiny88__)
+#elif defined (__AVR_ATtiny167__)
+#elif defined (__AVR_ATmega8U2__)
+									#define	_AVR_CPU_NAME_	"ATmega8U2"
+#else
+	#error cpu not defined
+#endif
+
+
+#if !defined (_AVR_CPU_NAME_)
+//	#define	_AVR_CPU_NAME_	"UNKNOWN"
+#endif

bootloaders/stk500v2/command.h

@@ -0,0 +1,114 @@
+//**** ATMEL AVR - A P P L I C A T I O N   N O T E  ************************
+//*
+//* Title:		AVR068 - STK500 Communication Protocol
+//* Filename:		command.h
+//* Version:		1.0
+//* Last updated:	31.01.2005
+//*
+//* Support E-mail:	avr@atmel.com
+//*
+//**************************************************************************
+
+// *****************[ STK message constants ]***************************
+
+#define MESSAGE_START                       0x1B        //= ESC = 27 decimal
+#define TOKEN                               0x0E
+
+// *****************[ STK general command constants ]**************************
+
+#define CMD_SIGN_ON                         0x01
+#define CMD_SET_PARAMETER                   0x02
+#define CMD_GET_PARAMETER                   0x03
+#define CMD_SET_DEVICE_PARAMETERS           0x04
+#define CMD_OSCCAL                          0x05
+#define CMD_LOAD_ADDRESS                    0x06
+#define CMD_FIRMWARE_UPGRADE                0x07
+
+
+// *****************[ STK ISP command constants ]******************************
+
+#define CMD_ENTER_PROGMODE_ISP              0x10
+#define CMD_LEAVE_PROGMODE_ISP              0x11
+#define CMD_CHIP_ERASE_ISP                  0x12
+#define CMD_PROGRAM_FLASH_ISP               0x13
+#define CMD_READ_FLASH_ISP                  0x14
+#define CMD_PROGRAM_EEPROM_ISP              0x15
+#define CMD_READ_EEPROM_ISP                 0x16
+#define CMD_PROGRAM_FUSE_ISP                0x17
+#define CMD_READ_FUSE_ISP                   0x18
+#define CMD_PROGRAM_LOCK_ISP                0x19
+#define CMD_READ_LOCK_ISP                   0x1A
+#define CMD_READ_SIGNATURE_ISP              0x1B
+#define CMD_READ_OSCCAL_ISP                 0x1C
+#define CMD_SPI_MULTI                       0x1D
+
+// *****************[ STK PP command constants ]*******************************
+
+#define CMD_ENTER_PROGMODE_PP               0x20
+#define CMD_LEAVE_PROGMODE_PP               0x21
+#define CMD_CHIP_ERASE_PP                   0x22
+#define CMD_PROGRAM_FLASH_PP                0x23
+#define CMD_READ_FLASH_PP                   0x24
+#define CMD_PROGRAM_EEPROM_PP               0x25
+#define CMD_READ_EEPROM_PP                  0x26
+#define CMD_PROGRAM_FUSE_PP                 0x27
+#define CMD_READ_FUSE_PP                    0x28
+#define CMD_PROGRAM_LOCK_PP                 0x29
+#define CMD_READ_LOCK_PP                    0x2A
+#define CMD_READ_SIGNATURE_PP               0x2B
+#define CMD_READ_OSCCAL_PP                  0x2C    
+
+#define CMD_SET_CONTROL_STACK               0x2D
+
+// *****************[ STK HVSP command constants ]*****************************
+
+#define CMD_ENTER_PROGMODE_HVSP             0x30
+#define CMD_LEAVE_PROGMODE_HVSP             0x31
+#define CMD_CHIP_ERASE_HVSP                 0x32
+#define CMD_PROGRAM_FLASH_HVSP  `     0x33
+#define CMD_READ_FLASH_HVSP                 0x34
+#define CMD_PROGRAM_EEPROM_HVSP             0x35
+#define CMD_READ_EEPROM_HVSP                0x36
+#define CMD_PROGRAM_FUSE_HVSP               0x37
+#define CMD_READ_FUSE_HVSP                  0x38
+#define CMD_PROGRAM_LOCK_HVSP               0x39
+#define CMD_READ_LOCK_HVSP                  0x3A
+#define CMD_READ_SIGNATURE_HVSP             0x3B
+#define CMD_READ_OSCCAL_HVSP                0x3C
+
+// *****************[ STK status constants ]***************************
+
+// Success
+#define STATUS_CMD_OK                       0x00
+
+// Warnings
+#define STATUS_CMD_TOUT                     0x80
+#define STATUS_RDY_BSY_TOUT                 0x81
+#define STATUS_SET_PARAM_MISSING            0x82
+
+// Errors
+#define STATUS_CMD_FAILED                   0xC0
+#define STATUS_CKSUM_ERROR                  0xC1
+#define STATUS_CMD_UNKNOWN                  0xC9
+
+// *****************[ STK parameter constants ]***************************
+#define PARAM_BUILD_NUMBER_LOW              0x80
+#define PARAM_BUILD_NUMBER_HIGH             0x81
+#define PARAM_HW_VER                        0x90
+#define PARAM_SW_MAJOR                      0x91
+#define PARAM_SW_MINOR                      0x92
+#define PARAM_VTARGET                       0x94
+#define PARAM_VADJUST                       0x95
+#define PARAM_OSC_PSCALE                    0x96
+#define PARAM_OSC_CMATCH                    0x97
+#define PARAM_SCK_DURATION                  0x98
+#define PARAM_TOPCARD_DETECT                0x9A
+#define PARAM_STATUS                        0x9C
+#define PARAM_DATA                          0x9D
+#define PARAM_RESET_POLARITY                0x9E
+#define PARAM_CONTROLLER_INIT               0x9F
+
+// *****************[ STK answer constants ]***************************
+
+#define ANSWER_CKSUM_ERROR                  0xB0
+

bootloaders/stk500v2/makedep.mk

@@ -0,0 +1,6 @@
+################################################################################
+# Automatically-generated file. Do not edit or delete the file
+################################################################################
+
+stk500boot.c
+

bootloaders/stk500v2/stk500boot.componentinfo.xml

@@ -0,0 +1,86 @@
+<?xml version="1.0" encoding="utf-8"?>
+<Store xmlns:i="http://www.w3.org/2001/XMLSchema-instance" xmlns="AtmelPackComponentManagement">
+	<ProjectComponents>
+		<ProjectComponent z:Id="i1" xmlns:z="http://schemas.microsoft.com/2003/10/Serialization/">
+			<CApiVersion></CApiVersion>
+			<CBundle></CBundle>
+			<CClass>Device</CClass>
+			<CGroup>Startup</CGroup>
+			<CSub></CSub>
+			<CVariant></CVariant>
+			<CVendor>Atmel</CVendor>
+			<CVersion>1.7.0</CVersion>
+			<DefaultRepoPath>C:/Program Files (x86)\Atmel\Studio\7.0\Packs</DefaultRepoPath>
+			<DependentComponents xmlns:d4p1="http://schemas.microsoft.com/2003/10/Serialization/Arrays" />
+			<Description></Description>
+			<Files xmlns:d4p1="http://schemas.microsoft.com/2003/10/Serialization/Arrays">
+				<d4p1:anyType i:type="FileInfo">
+					<AbsolutePath>C:/Program Files (x86)\Atmel\Studio\7.0\Packs\Atmel\ATmega_DFP\1.7.374\include\</AbsolutePath>
+					<Attribute></Attribute>
+					<Category>include</Category>
+					<Condition>C</Condition>
+					<FileContentHash i:nil="true" />
+					<FileVersion></FileVersion>
+					<Name>include/</Name>
+					<SelectString></SelectString>
+					<SourcePath></SourcePath>
+				</d4p1:anyType>
+				<d4p1:anyType i:type="FileInfo">
+					<AbsolutePath>C:/Program Files (x86)\Atmel\Studio\7.0\Packs\Atmel\ATmega_DFP\1.7.374\include\avr\iom2560.h</AbsolutePath>
+					<Attribute></Attribute>
+					<Category>header</Category>
+					<Condition>C</Condition>
+					<FileContentHash>MkwPezikXVtYA90mpLpFfA==</FileContentHash>
+					<FileVersion></FileVersion>
+					<Name>include/avr/iom2560.h</Name>
+					<SelectString></SelectString>
+					<SourcePath></SourcePath>
+				</d4p1:anyType>
+				<d4p1:anyType i:type="FileInfo">
+					<AbsolutePath>C:/Program Files (x86)\Atmel\Studio\7.0\Packs\Atmel\ATmega_DFP\1.7.374\templates\main.c</AbsolutePath>
+					<Attribute>template</Attribute>
+					<Category>source</Category>
+					<Condition>C Exe</Condition>
+					<FileContentHash>iLje1HNt5V/l3ISGz67DFw==</FileContentHash>
+					<FileVersion></FileVersion>
+					<Name>templates/main.c</Name>
+					<SelectString>Main file (.c)</SelectString>
+					<SourcePath></SourcePath>
+				</d4p1:anyType>
+				<d4p1:anyType i:type="FileInfo">
+					<AbsolutePath>C:/Program Files (x86)\Atmel\Studio\7.0\Packs\Atmel\ATmega_DFP\1.7.374\templates\main.cpp</AbsolutePath>
+					<Attribute>template</Attribute>
+					<Category>source</Category>
+					<Condition>C Exe</Condition>
+					<FileContentHash>mkKaE95TOoATsuBGv6jmxg==</FileContentHash>
+					<FileVersion></FileVersion>
+					<Name>templates/main.cpp</Name>
+					<SelectString>Main file (.cpp)</SelectString>
+					<SourcePath></SourcePath>
+				</d4p1:anyType>
+				<d4p1:anyType i:type="FileInfo">
+					<AbsolutePath>C:/Program Files (x86)\Atmel\Studio\7.0\Packs\Atmel\ATmega_DFP\1.7.374\gcc\dev\atmega2560</AbsolutePath>
+					<Attribute></Attribute>
+					<Category>libraryPrefix</Category>
+					<Condition>GCC</Condition>
+					<FileContentHash i:nil="true" />
+					<FileVersion></FileVersion>
+					<Name>gcc/dev/atmega2560</Name>
+					<SelectString></SelectString>
+					<SourcePath></SourcePath>
+				</d4p1:anyType>
+			</Files>
+			<PackName>ATmega_DFP</PackName>
+			<PackPath>C:/Program Files (x86)/Atmel/Studio/7.0/Packs/Atmel/ATmega_DFP/1.7.374/Atmel.ATmega_DFP.pdsc</PackPath>
+			<PackVersion>1.7.374</PackVersion>
+			<PresentInProject>true</PresentInProject>
+			<ReferenceConditionId>ATmega2560</ReferenceConditionId>
+			<RteComponents xmlns:d4p1="http://schemas.microsoft.com/2003/10/Serialization/Arrays">
+				<d4p1:string></d4p1:string>
+			</RteComponents>
+			<Status>Resolved</Status>
+			<VersionMode>Fixed</VersionMode>
+			<IsComponentInAtProject>true</IsComponentInAtProject>
+		</ProjectComponent>
+	</ProjectComponents>
+</Store>

bootloaders/stk500v2/stk500boot.cproj

@@ -0,0 +1,174 @@
+<?xml version="1.0" encoding="utf-8"?>
+<Project DefaultTargets="Build" xmlns="http://schemas.microsoft.com/developer/msbuild/2003" ToolsVersion="14.0">
+  <PropertyGroup>
+    <SchemaVersion>2.0</SchemaVersion>
+    <ProjectVersion>7.0</ProjectVersion>
+    <ToolchainName>com.Atmel.AVRGCC8.C</ToolchainName>
+    <ProjectGuid>dce6c7e3-ee26-4d79-826b-08594b9ad897</ProjectGuid>
+    <avrdevice>ATmega2560</avrdevice>
+    <avrdeviceseries>none</avrdeviceseries>
+    <OutputType>Executable</OutputType>
+    <Language>C</Language>
+    <OutputFileName>$(MSBuildProjectName)</OutputFileName>
+    <OutputFileExtension>.elf</OutputFileExtension>
+    <OutputDirectory>$(MSBuildProjectDirectory)\$(Configuration)</OutputDirectory>
+    <AssemblyName>STK500</AssemblyName>
+    <Name>stk500boot</Name>
+    <RootNamespace>STK500</RootNamespace>
+    <ToolchainFlavour>Native</ToolchainFlavour>
+    <KeepTimersRunning>true</KeepTimersRunning>
+    <OverrideVtor>false</OverrideVtor>
+    <CacheFlash>true</CacheFlash>
+    <ProgFlashFromRam>true</ProgFlashFromRam>
+    <RamSnippetAddress>0x20000000</RamSnippetAddress>
+    <UncachedRange />
+    <preserveEEPROM>true</preserveEEPROM>
+    <OverrideVtorValue>exception_table</OverrideVtorValue>
+    <BootSegment>2</BootSegment>
+    <ResetRule>0</ResetRule>
+    <eraseonlaunchrule>0</eraseonlaunchrule>
+    <EraseKey />
+    <avrtool>com.atmel.avrdbg.tool.atmelice</avrtool>
+    <avrtoolserialnumber>J41800094359</avrtoolserialnumber>
+    <avrdeviceexpectedsignature>0x1E9801</avrdeviceexpectedsignature>
+    <com_atmel_avrdbg_tool_atmelice>
+      <ToolOptions>
+        <InterfaceProperties>
+          <JtagDbgClock>200000</JtagDbgClock>
+          <IspClock>125000</IspClock>
+        </InterfaceProperties>
+        <InterfaceName>ISP</InterfaceName>
+      </ToolOptions>
+      <ToolType>com.atmel.avrdbg.tool.atmelice</ToolType>
+      <ToolNumber>J41800094359</ToolNumber>
+      <ToolName>Atmel-ICE</ToolName>
+    </com_atmel_avrdbg_tool_atmelice>
+    <avrtoolinterface>ISP</avrtoolinterface>
+    <avrtoolinterfaceclock>125000</avrtoolinterfaceclock>
+    <com_atmel_avrdbg_tool_simulator>
+      <ToolOptions xmlns="">
+        <InterfaceProperties>
+        </InterfaceProperties>
+        <InterfaceName>
+        </InterfaceName>
+      </ToolOptions>
+      <ToolType xmlns="">com.atmel.avrdbg.tool.simulator</ToolType>
+      <ToolNumber xmlns="">
+      </ToolNumber>
+      <ToolName xmlns="">Simulator</ToolName>
+    </com_atmel_avrdbg_tool_simulator>
+  </PropertyGroup>
+  <PropertyGroup Condition=" '$(Configuration)' == 'Release' ">
+    <ToolchainSettings>
+      <AvrGcc>
+        <avrgcc.common.Device>-mmcu=atmega2560 -B "%24(PackRepoDir)\Atmel\ATmega_DFP\1.7.374\gcc\dev\atmega2560"</avrgcc.common.Device>
+        <avrgcc.common.optimization.RelaxBranches>True</avrgcc.common.optimization.RelaxBranches>
+        <avrgcc.common.outputfiles.hex>True</avrgcc.common.outputfiles.hex>
+        <avrgcc.common.outputfiles.lss>True</avrgcc.common.outputfiles.lss>
+        <avrgcc.common.outputfiles.eep>True</avrgcc.common.outputfiles.eep>
+        <avrgcc.common.outputfiles.srec>True</avrgcc.common.outputfiles.srec>
+        <avrgcc.common.outputfiles.usersignatures>False</avrgcc.common.outputfiles.usersignatures>
+        <avrgcc.compiler.general.ChangeDefaultCharTypeUnsigned>True</avrgcc.compiler.general.ChangeDefaultCharTypeUnsigned>
+        <avrgcc.compiler.general.ChangeDefaultBitFieldUnsigned>True</avrgcc.compiler.general.ChangeDefaultBitFieldUnsigned>
+        <avrgcc.compiler.symbols.DefSymbols>
+          <ListValues>
+            <Value>NDEBUG</Value>
+          </ListValues>
+        </avrgcc.compiler.symbols.DefSymbols>
+        <avrgcc.compiler.directories.IncludePaths>
+          <ListValues>
+            <Value>%24(PackRepoDir)\Atmel\ATmega_DFP\1.7.374\include\</Value>
+          </ListValues>
+        </avrgcc.compiler.directories.IncludePaths>
+        <avrgcc.compiler.optimization.level>Optimize for size (-Os)</avrgcc.compiler.optimization.level>
+        <avrgcc.compiler.optimization.PackStructureMembers>True</avrgcc.compiler.optimization.PackStructureMembers>
+        <avrgcc.compiler.optimization.AllocateBytesNeededForEnum>True</avrgcc.compiler.optimization.AllocateBytesNeededForEnum>
+        <avrgcc.compiler.warnings.AllWarnings>True</avrgcc.compiler.warnings.AllWarnings>
+        <avrgcc.linker.libraries.Libraries>
+          <ListValues>
+            <Value>libm</Value>
+          </ListValues>
+        </avrgcc.linker.libraries.Libraries>
+        <avrgcc.assembler.general.IncludePaths>
+          <ListValues>
+            <Value>%24(PackRepoDir)\Atmel\ATmega_DFP\1.7.374\include\</Value>
+          </ListValues>
+        </avrgcc.assembler.general.IncludePaths>
+      </AvrGcc>
+    </ToolchainSettings>
+  </PropertyGroup>
+  <PropertyGroup Condition=" '$(Configuration)' == 'Debug' ">
+    <ToolchainSettings>
+      <AvrGcc>
+        <avrgcc.common.Device>-mmcu=atmega2560 -B "%24(PackRepoDir)\Atmel\ATmega_DFP\1.7.374\gcc\dev\atmega2560"</avrgcc.common.Device>
+        <avrgcc.common.optimization.RelaxBranches>True</avrgcc.common.optimization.RelaxBranches>
+        <avrgcc.common.outputfiles.hex>True</avrgcc.common.outputfiles.hex>
+        <avrgcc.common.outputfiles.lss>True</avrgcc.common.outputfiles.lss>
+        <avrgcc.common.outputfiles.eep>True</avrgcc.common.outputfiles.eep>
+        <avrgcc.common.outputfiles.srec>True</avrgcc.common.outputfiles.srec>
+        <avrgcc.common.outputfiles.usersignatures>False</avrgcc.common.outputfiles.usersignatures>
+        <avrgcc.compiler.general.ChangeDefaultCharTypeUnsigned>True</avrgcc.compiler.general.ChangeDefaultCharTypeUnsigned>
+        <avrgcc.compiler.general.ChangeDefaultBitFieldUnsigned>True</avrgcc.compiler.general.ChangeDefaultBitFieldUnsigned>
+        <avrgcc.compiler.symbols.DefSymbols>
+          <ListValues>
+            <Value>DEBUG</Value>
+            <Value>F_CPU=16000000UL</Value>
+          </ListValues>
+        </avrgcc.compiler.symbols.DefSymbols>
+        <avrgcc.compiler.directories.IncludePaths>
+          <ListValues>
+            <Value>%24(PackRepoDir)\Atmel\ATmega_DFP\1.7.374\include\</Value>
+          </ListValues>
+        </avrgcc.compiler.directories.IncludePaths>
+        <avrgcc.compiler.optimization.level>Optimize for size (-Os)</avrgcc.compiler.optimization.level>
+        <avrgcc.compiler.optimization.PackStructureMembers>True</avrgcc.compiler.optimization.PackStructureMembers>
+        <avrgcc.compiler.optimization.AllocateBytesNeededForEnum>True</avrgcc.compiler.optimization.AllocateBytesNeededForEnum>
+        <avrgcc.compiler.optimization.DebugLevel>Default (-g2)</avrgcc.compiler.optimization.DebugLevel>
+        <avrgcc.compiler.warnings.AllWarnings>True</avrgcc.compiler.warnings.AllWarnings>
+        <avrgcc.linker.libraries.Libraries>
+          <ListValues>
+            <Value>libm</Value>
+          </ListValues>
+        </avrgcc.linker.libraries.Libraries>
+        <avrgcc.linker.memorysettings.Flash>
+          <ListValues>
+            <Value>.text=3e000</Value>
+          </ListValues>
+        </avrgcc.linker.memorysettings.Flash>
+        <avrgcc.assembler.general.IncludePaths>
+          <ListValues>
+            <Value>%24(PackRepoDir)\Atmel\ATmega_DFP\1.7.374\include\</Value>
+          </ListValues>
+        </avrgcc.assembler.general.IncludePaths>
+        <avrgcc.assembler.debugging.DebugLevel>Default (-Wa,-g)</avrgcc.assembler.debugging.DebugLevel>
+      </AvrGcc>
+    </ToolchainSettings>
+    <UsesExternalMakeFile>False</UsesExternalMakeFile>
+    <OutputDirectory>$(MSBuildProjectDirectory)\$(Configuration)</OutputDirectory>
+    <BuildTarget>mega2560</BuildTarget>
+    <CleanTarget>clean</CleanTarget>
+    <ExternalMakeFilePath>C:\Users\Kirill\Documents\GIT\STK500\STK500\Debug\Makefile</ExternalMakeFilePath>
+    <OutputFileName>stk500boot_v2_mega2560</OutputFileName>
+    <OutputFileExtension>.elf</OutputFileExtension>
+  </PropertyGroup>
+  <ItemGroup>
+    <Compile Include="avrinterruptnames.h">
+      <SubType>compile</SubType>
+    </Compile>
+    <Compile Include="avr_cpunames.h">
+      <SubType>compile</SubType>
+    </Compile>
+    <Compile Include="command.h">
+      <SubType>compile</SubType>
+    </Compile>
+    <Compile Include="stk500boot.c">
+      <SubType>compile</SubType>
+    </Compile>
+  </ItemGroup>
+  <ItemGroup>
+    <None Include="License.txt">
+      <SubType>compile</SubType>
+    </None>
+  </ItemGroup>
+  <Import Project="$(AVRSTUDIO_EXE_PATH)\\Vs\\Compiler.targets" />
+</Project>

bootloaders/stk500v2/stk500boot.d

@@ -0,0 +1,67 @@
+stk500boot.d stk500boot.o: .././stk500boot.c \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\inttypes.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdint.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdint.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\io.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\sfr_defs.h \
+ C:\Program\ Files\ (x86)\Atmel\Studio\7.0\Packs\Atmel\ATmega_DFP\1.7.374\include/avr/iom2560.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\portpins.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\common.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\version.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\fuse.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\lock.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\interrupt.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\boot.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\eeprom.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stddef.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include-fixed\limits.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\pgmspace.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\util\delay.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\util\delay_basic.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\math.h \
+ c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdlib.h \
+ .././command.h
+
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\inttypes.h:
+
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stdint.h:
+
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdint.h:
+
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\io.h:
+
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\sfr_defs.h:
+
+C:\Program\ Files\ (x86)\Atmel\Studio\7.0\Packs\Atmel\ATmega_DFP\1.7.374\include/avr/iom2560.h:
+
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\portpins.h:
+
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\common.h:
+
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\version.h:
+
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\fuse.h:
+
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\lock.h:
+
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\interrupt.h:
+
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\boot.h:
+
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\eeprom.h:
+
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include\stddef.h:
+
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\lib\gcc\avr\5.4.0\include-fixed\limits.h:
+
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\avr\pgmspace.h:
+
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\util\delay.h:
+
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\util\delay_basic.h:
+
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\math.h:
+
+c:\program\ files\ (x86)\atmel\studio\7.0\toolchain\avr8\avr8-gnu-toolchain\avr\include\stdlib.h:
+
+.././command.h:

bootloaders/stk500v2/stk500boot_v2_mega2560.eep

@@ -0,0 +1,2 @@
+:040000033000E000E9
+:00000001FF

bootloaders/stk500v2/stk500boot_v2_mega2560.hex

@@ -0,0 +1,124 @@
+:020000023000CC
+:10E0000095C00000B9C00000B7C00000B5C0000056
+:10E01000B3C00000B1C00000AFC00000ADC0000040
+:10E02000ABC00000A9C00000A7C00000A5C0000050
+:10E03000A3C00000A1C000009FC000009DC0000060
+:10E040009BC0000099C0000097C0000095C0000070
+:10E0500093C0000091C000008FC000008DC0000080
+:10E060008BC0000089C0000087C0000085C0000090
+:10E0700083C0000081C000007FC000007DC00000A0
+:10E080007BC0000079C0000077C0000075C00000B0
+:10E0900073C0000071C000006FC000006DC00000C0
+:10E0A0006BC0000069C0000067C0000065C00000D0
+:10E0B00063C0000061C000005FC000005DC00000E0
+:10E0C0005BC0000059C0000057C0000055C00000F0
+:10E0D00053C0000051C000004FC000004DC0000000
+:10E0E0004BC000006BF171F179F180F184F18CF19A
+:10E0F0009DF1DDF1B0F1F4F11EF31EF33EF21EF3DB
+:10E100001EF31EF31EF31EF31EF31EF31EF31EF387
+:10E11000B0F104F235F24BF2C5F24BF2C5F21EF348
+:10E1200020F21EF313F208F21EF3B2F111241FBE07
+:10E13000CFEFD1E2DEBFCDBF01E00CBF12E0A0E027
+:10E14000B2E0EAE7F7EE03E00BBF02C007900D92E2
+:10E15000A430B107D9F722E0A4E0B2E001C01D92DB
+:10E16000A630B207E1F715D006C301E20EBF0FEFEC
+:10E170000DBF11241FBE0DC043CF8093C6008091F8
+:10E18000C00086FFFCCF8091C00080648093C000F7
+:10E190000895CF93DF93CDB7DEB7C052D1400FB60D
+:10E1A000F894DEBF0FBECDBF01E20EBF0FEF0DBF73
+:10E1B00094B7F894A89514BE80916000886180930C
+:10E1C000600010926000789493FF05C0E091040213
+:10E1D000F091050219958091C00082608093C00083
+:10E1E00080E18093C40088E18093C100000000E0DA
+:10E1F00010E0C12CD12C760197EC892E9BE1992E51
+:10E20000A12CB12C24E0722E8091C00087FD25C086
+:10E210000115110511F525E02A95F1F700003FEFF2
+:10E22000C31AD30AE30AF30A91E080E041E2C4167C
+:10E230004EE4D406E104F10408F490E0092F182F0D
+:10E24000C701B601A501940157D2672B682B692B32
+:10E25000D9F684B3872584BBD7CF0F5F1F4F01301A
+:10E26000110509F032C2C25EDE4F1882CE51D14094
+:10E27000D12C212C312C812C912C5401412C512C4E
+:10E28000320140E050E020E001301105B1F081E0C2
+:10E2900092E1AAE7B0E03091C00037FD0EC00197CF
+:10E2A000A109B109C1F7ABBFFC0187919691019615
+:10E2B00071F3EE27FF270994EACF9091C600E22E72
+:10E2C000F12CF7E0EF16F104D8F5F7018827EE58A6
+:10E2D000FF408E4F33C29B3109F405C200E010E0CD
+:10E2E000D3CFD926C25EDE4F9883CE51D14022E0F3
+:10E2F000F5CF492F50E0542F4427D92623E0EECF05
+:10E30000492BD92624E0EACF9E3009F0F0C1D92666
+:10E31000212C312C25E0E2CFB1016F5F7F4FE1E08E
+:10E32000F0E0EC0FFD1FE20DF31D9083D926461798
+:10E33000570709F4DEC11B01D1CF9D11D8C102C01E
+:10E34000273061F62981822F90E0FC013197ED3171
+:10E35000F10508F073C18827E758FF408E4FEEC1E2
+:10E36000C12C54C09D81903339F48F818823B1F042
+:10E370008130B1F488E917C0892F807599F0903504
+:10E3800021F489E0E0E0F0E005C0983559F4E3E0DD
+:10E39000F0E089E080935700849105C08EE103C0CE
+:10E3A00081E001C080E01A821B829C831D828E83E3
+:10E3B0001F82C12C07E010E046C11A8288E08B83DF
+:10E3C00081E48C8386E58D8382E58E8389E48F8367
+:10E3D00083E5888780E589878FE58A8782E38B8755
+:10E3E000C12C0BE010E02FC1EA81E059E33028F4A2
+:10E3F000F0E0E050FE4F808101C080E01A828B8304
+:10E40000C12C03E010E01FC1CC24C3941A8219C1AF
+:10E410008D81882321F0813021F488E924C08EE1A8
+:10E4200022C081E020C01A82E1E0F0E089E0809320
+:10E43000570084918B831C82C12C04E010E003C13F
+:10E440008B81803551F48C81883019F4E2E0F0E062
+:10E4500006C089E0E0E0F0E003C0E3E0F0E089E03E
+:10E460008093570084911A82E5CF80EC8A83C12C77
+:10E4700002E010E0812C912C5401E5C06A817B817F
+:10E480008C819D8163D12B013C01440C551C661C81
+:10E49000771C1A82D5C0EA80FB80FE24EF24FE247C
+:10E4A000233109F03CC0811440EC940643E0A406FB
+:10E4B000B10478F423E0F401A0925B0020935700AC
+:10E4C000E89507B600FCFDCF3FEF931AA30AB30A05
+:10E4D000EACF93018201DE011B968D919D9141E06F
+:10E4E0000C01F80120935B0040935700E89511243C
+:10E4F0000E5F1F4F2F4F3F4F82E0E81AF10869F778
+:10E5000095E0F20160925B0090935700E89507B6A2
+:10E5100000FCFDCF81E180935700E89532C0D30124
+:10E52000C201B695A795979587956C01FE013B961C
+:10E53000C15EDE4FF983E883CF51D14000E010E0A7
+:10E540000E151F05A1F0C15EDE4FE881F981CF51A4
+:10E55000D1406191C15EDE4FF983E883CF51D14054
+:10E56000C8018C0D9D1DF9D00F5F1F4FE9CF20E032
+:10E5700030E0000F111F221F331F040D151D261D33
+:10E58000371D1A82280139015BC08A819B81982737
+:10E59000892798278C010D5F1F4F1A82243101F5BE
+:10E5A0008114F0EC9F06F3E0AF06B10408F446C016
+:10E5B000DE0111966BBEF2012791369112962C93D3
+:10E5C0001297FD01349613963C93139722E0420E66
+:10E5D000511C611C711C02971296009759F72BC0B1
+:10E5E000FE0131969F01280F391FB301A20141BDE1
+:10E5F000C52ED62EE72EFF24C2BC4F5F5F4F6F4F54
+:10E600007F4FF89AA0B5A28331962E173F0779F76E
+:10E61000AC014150510960E070E04F5F5F4F6F4FB8
+:10E620007F4F440E551E661E771EE3E0F0E0EC0FB0
+:10E63000FD1FE80FF91F1082C12C05C080EC8A83F2
+:10E64000C12C02E010E08BE198DDC25EDE4F8881D4
+:10E65000CE51D14092DD812F90DD802F8EDD85E17E
+:10E66000C25EDE4FD880CE51D140D826D0268EE073
+:10E6700084DDD126CE0101967C01080F191F0E15ED
+:10E680001F0589F0F70121917F01C15EDE4F2883CC
+:10E69000CF51D140822F71DDC15EDE4F3881CF5125
+:10E6A000D140D326ECCF8D2D68DDC25EDE4F488190
+:10E6B000CE51D1404F5FC25EDE4F4883CE51D14034
+:10E6C00000E010E0CC2009F4DCCD00008091C00017
+:10E6D0008D7F8093C00081E180935700E895EE27FD
+:10E6E000FF270994FFCF8BE1D82E21E0F7CD20E062
+:10E6F000F5CD1A0126E0F2CDA1E21A2EAA1BBB1B12
+:10E70000FD010DC0AA1FBB1FEE1FFF1FA217B307FD
+:10E71000E407F50720F0A21BB30BE40BF50B661F13
+:10E72000771F881F991F1A9469F7609570958095D7
+:10E7300090959B01AC01BD01CF010895EE0FFF1F25
+:10E74000881F8BBF0790F691E02D199469279627B3
+:10E7500069277827872778270895262FF999FECFEC
+:10E760001FBA92BD81BD20BD0FB6F894FA9AF99AEE
+:0AE770000FBE01960895F894FFCF44
+:04E77A000F020A0080
+:040000033000E000E9
+:00000001FF

bootloaders/stk500v2/stk500boot_v2_mega2560.map

@@ -0,0 +1,582 @@
+Archive member included to satisfy reference by file (symbol)
+
+c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_udivmodsi4.o)
+                              stk500boot.o (__udivmodsi4)
+c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_exit.o)
+                              C:/Program Files (x86)/Atmel/Studio/7.0/Packs/Atmel/ATmega_DFP/1.7.374/gcc/dev/atmega2560/avr6/crtatmega2560.o (exit)
+c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_tablejump2.o)
+                              stk500boot.o (__tablejump2__)
+c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_copy_data.o)
+                              stk500boot.o (__do_copy_data)
+c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_clear_bss.o)
+                              stk500boot.o (__do_clear_bss)
+c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_bswapsi2.o)
+                              stk500boot.o (__bswapsi2)
+C:/Program Files (x86)/Atmel/Studio/7.0/Packs/Atmel/ATmega_DFP/1.7.374/gcc/dev/atmega2560/avr6\libatmega2560.a(eewr_byte.o)
+                              stk500boot.o (eeprom_write_byte)
+
+Discarded input sections
+
+ .data          0x00000000        0x0 C:/Program Files (x86)/Atmel/Studio/7.0/Packs/Atmel/ATmega_DFP/1.7.374/gcc/dev/atmega2560/avr6/crtatmega2560.o
+ .bss           0x00000000        0x0 C:/Program Files (x86)/Atmel/Studio/7.0/Packs/Atmel/ATmega_DFP/1.7.374/gcc/dev/atmega2560/avr6/crtatmega2560.o
+ .text          0x00000000        0x0 stk500boot.o
+ .data          0x00000000        0x0 stk500boot.o
+ .bss           0x00000000        0x0 stk500boot.o
+ .text.delay_ms
+                0x00000000       0x1e stk500boot.o
+ .text          0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_udivmodsi4.o)
+ .data          0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_udivmodsi4.o)
+ .bss           0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_udivmodsi4.o)
+ .text.libgcc.mul
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_udivmodsi4.o)
+ .text.libgcc   0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_udivmodsi4.o)
+ .text.libgcc.prologue
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_udivmodsi4.o)
+ .text.libgcc.builtins
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_udivmodsi4.o)
+ .text.libgcc.fmul
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_udivmodsi4.o)
+ .text.libgcc.fixed
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_udivmodsi4.o)
+ .text          0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_exit.o)
+ .data          0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_exit.o)
+ .bss           0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_exit.o)
+ .text.libgcc.mul
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_exit.o)
+ .text.libgcc.div
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_exit.o)
+ .text.libgcc   0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_exit.o)
+ .text.libgcc.prologue
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_exit.o)
+ .text.libgcc.builtins
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_exit.o)
+ .text.libgcc.fmul
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_exit.o)
+ .text.libgcc.fixed
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_exit.o)
+ .text          0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_tablejump2.o)
+ .data          0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_tablejump2.o)
+ .bss           0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_tablejump2.o)
+ .text.libgcc.mul
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_tablejump2.o)
+ .text.libgcc.div
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_tablejump2.o)
+ .text.libgcc.prologue
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_tablejump2.o)
+ .text.libgcc.builtins
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_tablejump2.o)
+ .text.libgcc.fmul
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_tablejump2.o)
+ .text.libgcc.fixed
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_tablejump2.o)
+ .text          0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_copy_data.o)
+ .data          0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_copy_data.o)
+ .bss           0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_copy_data.o)
+ .text.libgcc.mul
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_copy_data.o)
+ .text.libgcc.div
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_copy_data.o)
+ .text.libgcc   0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_copy_data.o)
+ .text.libgcc.prologue
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_copy_data.o)
+ .text.libgcc.builtins
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_copy_data.o)
+ .text.libgcc.fmul
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_copy_data.o)
+ .text.libgcc.fixed
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_copy_data.o)
+ .text          0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_clear_bss.o)
+ .data          0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_clear_bss.o)
+ .bss           0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_clear_bss.o)
+ .text.libgcc.mul
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_clear_bss.o)
+ .text.libgcc.div
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_clear_bss.o)
+ .text.libgcc   0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_clear_bss.o)
+ .text.libgcc.prologue
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_clear_bss.o)
+ .text.libgcc.builtins
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_clear_bss.o)
+ .text.libgcc.fmul
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_clear_bss.o)
+ .text.libgcc.fixed
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_clear_bss.o)
+ .text          0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_bswapsi2.o)
+ .data          0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_bswapsi2.o)
+ .bss           0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_bswapsi2.o)
+ .text.libgcc.mul
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_bswapsi2.o)
+ .text.libgcc.div
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_bswapsi2.o)
+ .text.libgcc   0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_bswapsi2.o)
+ .text.libgcc.prologue
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_bswapsi2.o)
+ .text.libgcc.fmul
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_bswapsi2.o)
+ .text.libgcc.fixed
+                0x00000000        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_bswapsi2.o)
+ .text          0x00000000        0x0 C:/Program Files (x86)/Atmel/Studio/7.0/Packs/Atmel/ATmega_DFP/1.7.374/gcc/dev/atmega2560/avr6\libatmega2560.a(eewr_byte.o)
+ .data          0x00000000        0x0 C:/Program Files (x86)/Atmel/Studio/7.0/Packs/Atmel/ATmega_DFP/1.7.374/gcc/dev/atmega2560/avr6\libatmega2560.a(eewr_byte.o)
+ .bss           0x00000000        0x0 C:/Program Files (x86)/Atmel/Studio/7.0/Packs/Atmel/ATmega_DFP/1.7.374/gcc/dev/atmega2560/avr6\libatmega2560.a(eewr_byte.o)
+
+Memory Configuration
+
+Name             Origin             Length             Attributes
+text             0x00000000         0x00040000         xr
+data             0x00800200         0x00002000         rw !x
+eeprom           0x00810000         0x00001000         rw !x
+fuse             0x00820000         0x00000003         rw !x
+lock             0x00830000         0x00000400         rw !x
+signature        0x00840000         0x00000400         rw !x
+user_signatures  0x00850000         0x00000400         rw !x
+*default*        0x00000000         0xffffffff
+
+Linker script and memory map
+
+Address of section .data set to 0x800200
+LOAD C:/Program Files (x86)/Atmel/Studio/7.0/Packs/Atmel/ATmega_DFP/1.7.374/gcc/dev/atmega2560/avr6/crtatmega2560.o
+LOAD stk500boot.o
+START GROUP
+LOAD c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avr6\libm.a
+END GROUP
+Address of section .text set to 0x3e000
+START GROUP
+LOAD c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a
+LOAD c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avr6\libm.a
+LOAD c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/../../../../avr/lib/avr6\libc.a
+LOAD C:/Program Files (x86)/Atmel/Studio/7.0/Packs/Atmel/ATmega_DFP/1.7.374/gcc/dev/atmega2560/avr6\libatmega2560.a
+END GROUP
+                0x00000000                __TEXT_REGION_ORIGIN__ = DEFINED (__TEXT_REGION_ORIGIN__)?__TEXT_REGION_ORIGIN__:0x0
+                [0x00800200]                __DATA_REGION_ORIGIN__ = DEFINED (__DATA_REGION_ORIGIN__)?__DATA_REGION_ORIGIN__:0x800200
+                [0x00040000]                __TEXT_REGION_LENGTH__ = DEFINED (__TEXT_REGION_LENGTH__)?__TEXT_REGION_LENGTH__:0x100000
+                [0x00002000]                __DATA_REGION_LENGTH__ = DEFINED (__DATA_REGION_LENGTH__)?__DATA_REGION_LENGTH__:0xfe00
+                [0x00001000]                __EEPROM_REGION_LENGTH__ = DEFINED (__EEPROM_REGION_LENGTH__)?__EEPROM_REGION_LENGTH__:0x10000
+                [0x00000003]                __FUSE_REGION_LENGTH__ = DEFINED (__FUSE_REGION_LENGTH__)?__FUSE_REGION_LENGTH__:0x400
+                0x00000400                __LOCK_REGION_LENGTH__ = DEFINED (__LOCK_REGION_LENGTH__)?__LOCK_REGION_LENGTH__:0x400
+                0x00000400                __SIGNATURE_REGION_LENGTH__ = DEFINED (__SIGNATURE_REGION_LENGTH__)?__SIGNATURE_REGION_LENGTH__:0x400
+                0x00000400                __USER_SIGNATURE_REGION_LENGTH__ = DEFINED (__USER_SIGNATURE_REGION_LENGTH__)?__USER_SIGNATURE_REGION_LENGTH__:0x400
+
+.hash
+ *(.hash)
+
+.dynsym
+ *(.dynsym)
+
+.dynstr
+ *(.dynstr)
+
+.gnu.version
+ *(.gnu.version)
+
+.gnu.version_d
+ *(.gnu.version_d)
+
+.gnu.version_r
+ *(.gnu.version_r)
+
+.rel.init
+ *(.rel.init)
+
+.rela.init
+ *(.rela.init)
+
+.rel.text
+ *(.rel.text)
+ *(.rel.text.*)
+ *(.rel.gnu.linkonce.t*)
+
+.rela.text
+ *(.rela.text)
+ *(.rela.text.*)
+ *(.rela.gnu.linkonce.t*)
+
+.rel.fini
+ *(.rel.fini)
+
+.rela.fini
+ *(.rela.fini)
+
+.rel.rodata
+ *(.rel.rodata)
+ *(.rel.rodata.*)
+ *(.rel.gnu.linkonce.r*)
+
+.rela.rodata
+ *(.rela.rodata)
+ *(.rela.rodata.*)
+ *(.rela.gnu.linkonce.r*)
+
+.rel.data
+ *(.rel.data)
+ *(.rel.data.*)
+ *(.rel.gnu.linkonce.d*)
+
+.rela.data
+ *(.rela.data)
+ *(.rela.data.*)
+ *(.rela.gnu.linkonce.d*)
+
+.rel.ctors
+ *(.rel.ctors)
+
+.rela.ctors
+ *(.rela.ctors)
+
+.rel.dtors
+ *(.rel.dtors)
+
+.rela.dtors
+ *(.rela.dtors)
+
+.rel.got
+ *(.rel.got)
+
+.rela.got
+ *(.rela.got)
+
+.rel.bss
+ *(.rel.bss)
+
+.rela.bss
+ *(.rela.bss)
+
+.rel.plt
+ *(.rel.plt)
+
+.rela.plt
+ *(.rela.plt)
+
+.text           0x0003e000      0x77a
+ *(.vectors)
+ .vectors       0x0003e000       0xe4 C:/Program Files (x86)/Atmel/Studio/7.0/Packs/Atmel/ATmega_DFP/1.7.374/gcc/dev/atmega2560/avr6/crtatmega2560.o
+                0x0003e000                __vector_default
+                0x0003e000                __vectors
+ *(.vectors)
+ *(.progmem.gcc*)
+ .progmem.gcc_sw_table.main
+                0x0003e0e4       0x48 stk500boot.o
+                0x0003e12c                . = ALIGN (0x2)
+                0x0003e12c                __trampolines_start = .
+ *(.trampolines)
+ .trampolines   0x0003e12c        0x0 linker stubs
+ *(.trampolines*)
+                0x0003e12c                __trampolines_end = .
+ *libprintf_flt.a:*(.progmem.data)
+ *libc.a:*(.progmem.data)
+ *(.progmem*)
+                0x0003e12c                . = ALIGN (0x2)
+ *(.jumptables)
+ *(.jumptables*)
+ *(.lowtext)
+ *(.lowtext*)
+                0x0003e12c                __ctors_start = .
+ *(.ctors)
+                0x0003e12c                __ctors_end = .
+                0x0003e12c                __dtors_start = .
+ *(.dtors)
+                0x0003e12c                __dtors_end = .
+ SORT(*)(.ctors)
+ SORT(*)(.dtors)
+ *(.init0)
+ .init0         0x0003e12c        0x0 C:/Program Files (x86)/Atmel/Studio/7.0/Packs/Atmel/ATmega_DFP/1.7.374/gcc/dev/atmega2560/avr6/crtatmega2560.o
+                0x0003e12c                __init
+ *(.init0)
+ *(.init1)
+ *(.init1)
+ *(.init2)
+ .init2         0x0003e12c       0x10 C:/Program Files (x86)/Atmel/Studio/7.0/Packs/Atmel/ATmega_DFP/1.7.374/gcc/dev/atmega2560/avr6/crtatmega2560.o
+ *(.init2)
+ *(.init3)
+ *(.init3)
+ *(.init4)
+ .init4         0x0003e13c       0x1a c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_copy_data.o)
+                0x0003e13c                __do_copy_data
+ .init4         0x0003e156       0x10 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_clear_bss.o)
+                0x0003e156                __do_clear_bss
+ *(.init4)
+ *(.init5)
+ *(.init5)
+ *(.init6)
+ *(.init6)
+ *(.init7)
+ *(.init7)
+ *(.init8)
+ *(.init8)
+ *(.init9)
+ .init9         0x0003e166        0x4 C:/Program Files (x86)/Atmel/Studio/7.0/Packs/Atmel/ATmega_DFP/1.7.374/gcc/dev/atmega2560/avr6/crtatmega2560.o
+ .init9         0x0003e16a        0xe stk500boot.o
+                0x0003e16a                __jumpMain
+ *(.init9)
+ *(.text)
+ .text          0x0003e178        0x2 C:/Program Files (x86)/Atmel/Studio/7.0/Packs/Atmel/ATmega_DFP/1.7.374/gcc/dev/atmega2560/avr6/crtatmega2560.o
+                0x0003e178                __vector_38
+                0x0003e178                __vector_22
+                0x0003e178                __vector_28
+                0x0003e178                __vector_1
+                0x0003e178                __vector_32
+                0x0003e178                __vector_34
+                0x0003e178                __vector_24
+                0x0003e178                __vector_12
+                0x0003e178                __vector_55
+                0x0003e178                __vector_46
+                0x0003e178                __bad_interrupt
+                0x0003e178                __vector_6
+                0x0003e178                __vector_31
+                0x0003e178                __vector_35
+                0x0003e178                __vector_39
+                0x0003e178                __vector_3
+                0x0003e178                __vector_23
+                0x0003e178                __vector_30
+                0x0003e178                __vector_45
+                0x0003e178                __vector_25
+                0x0003e178                __vector_11
+                0x0003e178                __vector_54
+                0x0003e178                __vector_13
+                0x0003e178                __vector_17
+                0x0003e178                __vector_19
+                0x0003e178                __vector_56
+                0x0003e178                __vector_7
+                0x0003e178                __vector_49
+                0x0003e178                __vector_41
+                0x0003e178                __vector_43
+                0x0003e178                __vector_27
+                0x0003e178                __vector_5
+                0x0003e178                __vector_33
+                0x0003e178                __vector_47
+                0x0003e178                __vector_52
+                0x0003e178                __vector_37
+                0x0003e178                __vector_4
+                0x0003e178                __vector_44
+                0x0003e178                __vector_51
+                0x0003e178                __vector_9
+                0x0003e178                __vector_2
+                0x0003e178                __vector_21
+                0x0003e178                __vector_15
+                0x0003e178                __vector_36
+                0x0003e178                __vector_29
+                0x0003e178                __vector_40
+                0x0003e178                __vector_8
+                0x0003e178                __vector_26
+                0x0003e178                __vector_48
+                0x0003e178                __vector_14
+                0x0003e178                __vector_53
+                0x0003e178                __vector_10
+                0x0003e178                __vector_50
+                0x0003e178                __vector_16
+                0x0003e178                __vector_18
+                0x0003e178                __vector_20
+                0x0003e178                __vector_42
+                0x0003e17a                . = ALIGN (0x2)
+ *(.text.*)
+ .text.sendchar
+                0x0003e17a       0x18 stk500boot.o
+ .text.startup.main
+                0x0003e192      0x566 stk500boot.o
+                0x0003e192                main
+ .text.libgcc.div
+                0x0003e6f8       0x44 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_udivmodsi4.o)
+                0x0003e6f8                __udivmodsi4
+ .text.libgcc   0x0003e73c       0x10 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_tablejump2.o)
+                0x0003e73c                __tablejump2__
+ .text.libgcc.builtins
+                0x0003e74c        0xe c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_bswapsi2.o)
+                0x0003e74c                __bswapsi2
+ .text.avr-libc
+                0x0003e75a       0x1c C:/Program Files (x86)/Atmel/Studio/7.0/Packs/Atmel/ATmega_DFP/1.7.374/gcc/dev/atmega2560/avr6\libatmega2560.a(eewr_byte.o)
+                0x0003e75a                eeprom_write_byte
+                0x0003e75c                eeprom_write_r18
+                0x0003e776                . = ALIGN (0x2)
+ *(.fini9)
+ .fini9         0x0003e776        0x0 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_exit.o)
+                0x0003e776                _exit
+                0x0003e776                exit
+ *(.fini9)
+ *(.fini8)
+ *(.fini8)
+ *(.fini7)
+ *(.fini7)
+ *(.fini6)
+ *(.fini6)
+ *(.fini5)
+ *(.fini5)
+ *(.fini4)
+ *(.fini4)
+ *(.fini3)
+ *(.fini3)
+ *(.fini2)
+ *(.fini2)
+ *(.fini1)
+ *(.fini1)
+ *(.fini0)
+ .fini0         0x0003e776        0x4 c:/program files (x86)/atmel/studio/7.0/toolchain/avr8/avr8-gnu-toolchain/bin/../lib/gcc/avr/5.4.0/avr6\libgcc.a(_exit.o)
+ *(.fini0)
+                0x0003e77a                _etext = .
+
+.data           0x00800200        0x4 load address 0x0003e77a
+                0x00800200                PROVIDE (__data_start, .)
+ *(.data)
+ *(.data*)
+ *(.gnu.linkonce.d*)
+ *(.rodata)
+ *(.rodata*)
+ .rodata.CSWTCH.27
+                0x00800200        0x3 stk500boot.o
+ *(.gnu.linkonce.r*)
+                0x00800204                . = ALIGN (0x2)
+ *fill*         0x00800203        0x1 
+                0x00800204                _edata = .
+                0x00800204                PROVIDE (__data_end, .)
+
+.bss            0x00800204        0x2
+                0x00800204                PROVIDE (__bss_start, .)
+ *(.bss)
+ *(.bss*)
+ .bss.app_start
+                0x00800204        0x2 stk500boot.o
+                0x00800204                app_start
+ *(COMMON)
+                0x00800206                PROVIDE (__bss_end, .)
+                0x0003e77a                __data_load_start = LOADADDR (.data)
+                0x0003e77e                __data_load_end = (__data_load_start + SIZEOF (.data))
+
+.noinit         0x00800206        0x0
+                [!provide]                PROVIDE (__noinit_start, .)
+ *(.noinit*)
+                [!provide]                PROVIDE (__noinit_end, .)
+                0x00800206                _end = .
+                [!provide]                PROVIDE (__heap_start, .)
+
+.eeprom         0x00810000        0x0
+ *(.eeprom*)
+                0x00810000                __eeprom_end = .
+
+.fuse           0x00820000        0x3
+ *(.fuse)
+ .fuse          0x00820000        0x3 stk500boot.o
+                0x00820000                __fuse
+ *(.lfuse)
+ *(.hfuse)
+ *(.efuse)
+
+.lock           0x00830000        0x1
+ *(.lock*)
+ .lock          0x00830000        0x1 stk500boot.o
+                0x00830000                __lock
+
+.signature
+ *(.signature*)
+
+.user_signatures
+ *(.user_signatures*)
+
+.stab
+ *(.stab)
+
+.stabstr
+ *(.stabstr)
+
+.stab.excl
+ *(.stab.excl)
+
+.stab.exclstr
+ *(.stab.exclstr)
+
+.stab.index
+ *(.stab.index)
+
+.stab.indexstr
+ *(.stab.indexstr)
+
+.comment        0x00000000       0x30
+ *(.comment)
+ .comment       0x00000000       0x30 stk500boot.o
+                                 0x31 (size before relaxing)
+
+.note.gnu.avr.deviceinfo
+                0x00000000       0x40
+ .note.gnu.avr.deviceinfo
+                0x00000000       0x40 C:/Program Files (x86)/Atmel/Studio/7.0/Packs/Atmel/ATmega_DFP/1.7.374/gcc/dev/atmega2560/avr6/crtatmega2560.o
+
+.note.gnu.build-id
+ *(.note.gnu.build-id)
+
+.debug
+ *(.debug)
+
+.line
+ *(.line)
+
+.debug_srcinfo
+ *(.debug_srcinfo)
+
+.debug_sfnames
+ *(.debug_sfnames)
+
+.debug_aranges  0x00000000       0x58
+ *(.debug_aranges)
+ .debug_aranges
+                0x00000000       0x38 stk500boot.o
+ .debug_aranges
+                0x00000038       0x20 C:/Program Files (x86)/Atmel/Studio/7.0/Packs/Atmel/ATmega_DFP/1.7.374/gcc/dev/atmega2560/avr6\libatmega2560.a(eewr_byte.o)
+
+.debug_pubnames
+ *(.debug_pubnames)
+
+.debug_info     0x00000000     0x1367
+ *(.debug_info .gnu.linkonce.wi.*)
+ .debug_info    0x00000000      0xbbc C:/Program Files (x86)/Atmel/Studio/7.0/Packs/Atmel/ATmega_DFP/1.7.374/gcc/dev/atmega2560/avr6/crtatmega2560.o
+ .debug_info    0x00000bbc      0x711 stk500boot.o
+ .debug_info    0x000012cd       0x9a C:/Program Files (x86)/Atmel/Studio/7.0/Packs/Atmel/ATmega_DFP/1.7.374/gcc/dev/atmega2560/avr6\libatmega2560.a(eewr_byte.o)
+
+.debug_abbrev   0x00000000      0xdac
+ *(.debug_abbrev)
+ .debug_abbrev  0x00000000      0xb1a C:/Program Files (x86)/Atmel/Studio/7.0/Packs/Atmel/ATmega_DFP/1.7.374/gcc/dev/atmega2560/avr6/crtatmega2560.o
+ .debug_abbrev  0x00000b1a      0x27e stk500boot.o
+ .debug_abbrev  0x00000d98       0x14 C:/Program Files (x86)/Atmel/Studio/7.0/Packs/Atmel/ATmega_DFP/1.7.374/gcc/dev/atmega2560/avr6\libatmega2560.a(eewr_byte.o)
+
+.debug_line     0x00000000      0x988
+ *(.debug_line .debug_line.* .debug_line_end)
+ .debug_line    0x00000000      0x1fa C:/Program Files (x86)/Atmel/Studio/7.0/Packs/Atmel/ATmega_DFP/1.7.374/gcc/dev/atmega2560/avr6/crtatmega2560.o
+ .debug_line    0x000001fa      0x6f0 stk500boot.o
+ .debug_line    0x000008ea       0x9e C:/Program Files (x86)/Atmel/Studio/7.0/Packs/Atmel/ATmega_DFP/1.7.374/gcc/dev/atmega2560/avr6\libatmega2560.a(eewr_byte.o)
+
+.debug_frame    0x00000000       0x68
+ *(.debug_frame)
+ .debug_frame   0x00000000       0x68 stk500boot.o
+
+.debug_str      0x00000000      0x6f2
+ *(.debug_str)
+ .debug_str     0x00000000      0x3e6 C:/Program Files (x86)/Atmel/Studio/7.0/Packs/Atmel/ATmega_DFP/1.7.374/gcc/dev/atmega2560/avr6/crtatmega2560.o
+ .debug_str     0x000003e6      0x30c stk500boot.o
+                                0x356 (size before relaxing)
+
+.debug_loc      0x00000000      0xaa4
+ *(.debug_loc)
+ .debug_loc     0x00000000      0xaa4 stk500boot.o
+
+.debug_macinfo
+ *(.debug_macinfo)
+
+.debug_weaknames
+ *(.debug_weaknames)
+
+.debug_funcnames
+ *(.debug_funcnames)
+
+.debug_typenames
+ *(.debug_typenames)
+
+.debug_varnames
+ *(.debug_varnames)
+
+.debug_pubtypes
+ *(.debug_pubtypes)
+
+.debug_ranges   0x00000000       0x58
+ *(.debug_ranges)
+ .debug_ranges  0x00000000       0x58 stk500boot.o
+
+.debug_macro
+ *(.debug_macro)
+OUTPUT(stk500boot_v2_mega2560.elf elf32-avr)
+LOAD linker stubs

bootloaders/stk500v2/stk500boot_v2_mega2560.srec

@@ -0,0 +1,123 @@
+S01E000073746B353030626F6F745F76325F6D656761323536302E737265639E
+S21403E00095C00000B9C00000B7C00000B5C000004E
+S21403E010B3C00000B1C00000AFC00000ADC0000038
+S21403E020ABC00000A9C00000A7C00000A5C0000048
+S21403E030A3C00000A1C000009FC000009DC0000058
+S21403E0409BC0000099C0000097C0000095C0000068
+S21403E05093C0000091C000008FC000008DC0000078
+S21403E0608BC0000089C0000087C0000085C0000088
+S21403E07083C0000081C000007FC000007DC0000098
+S21403E0807BC0000079C0000077C0000075C00000A8
+S21403E09073C0000071C000006FC000006DC00000B8
+S21403E0A06BC0000069C0000067C0000065C00000C8
+S21403E0B063C0000061C000005FC000005DC00000D8
+S21403E0C05BC0000059C0000057C0000055C00000E8
+S21403E0D053C0000051C000004FC000004DC00000F8
+S21403E0E04BC000006BF171F179F180F184F18CF192
+S21403E0F09DF1DDF1B0F1F4F11EF31EF33EF21EF3D3
+S21403E1001EF31EF31EF31EF31EF31EF31EF31EF37F
+S21403E110B0F104F235F24BF2C5F24BF2C5F21EF340
+S21403E12020F21EF313F208F21EF3B2F111241FBEFF
+S21403E130CFEFD1E2DEBFCDBF01E00CBF12E0A0E01F
+S21403E140B2E0EAE7F7EE03E00BBF02C007900D92DA
+S21403E150A430B107D9F722E0A4E0B2E001C01D92D3
+S21403E160A630B207E1F715D006C301E20EBF0FEFE4
+S21403E1700DBF11241FBE0DC043CF8093C6008091F0
+S21403E180C00086FFFCCF8091C00080648093C000EF
+S21403E1900895CF93DF93CDB7DEB7C052D1400FB605
+S21403E1A0F894DEBF0FBECDBF01E20EBF0FEF0DBF6B
+S21403E1B094B7F894A89514BE809160008861809304
+S21403E1C0600010926000789493FF05C0E09104020B
+S21403E1D0F091050219958091C00082608093C0007B
+S21403E1E080E18093C40088E18093C100000000E0D2
+S21403E1F010E0C12CD12C760197EC892E9BE1992E49
+S21403E200A12CB12C24E0722E8091C00087FD25C07E
+S21403E2100115110511F525E02A95F1F700003FEFEA
+S21403E220C31AD30AE30AF30A91E080E041E2C41674
+S21403E2304EE4D406E104F10408F490E0092F182F05
+S21403E240C701B601A501940157D2672B682B692B2A
+S21403E250D9F684B3872584BBD7CF0F5F1F4F013012
+S21403E260110509F032C2C25EDE4F1882CE51D1408C
+S21403E270D12C212C312C812C912C5401412C512C46
+S21403E280320140E050E020E001301105B1F081E0BA
+S21403E29092E1AAE7B0E03091C00037FD0EC00197C7
+S21403E2A0A109B109C1F7ABBFFC018791969101960D
+S21403E2B071F3EE27FF270994EACF9091C600E22E6A
+S21403E2C0F12CF7E0EF16F104D8F5F7018827EE589E
+S21403E2D0FF408E4F33C29B3109F405C200E010E0C5
+S21403E2E0D3CFD926C25EDE4F9883CE51D14022E0EB
+S21403E2F0F5CF492F50E0542F4427D92623E0EECFFD
+S21403E300492BD92624E0EACF9E3009F0F0C1D9265E
+S21403E310212C312C25E0E2CFB1016F5F7F4FE1E086
+S21403E320F0E0EC0FFD1FE20DF31D9083D926461790
+S21403E330570709F4DEC11B01D1CF9D11D8C102C016
+S21403E340273061F62981822F90E0FC013197ED3169
+S21403E350F10508F073C18827E758FF408E4FEEC1DA
+S21403E360C12C54C09D81903339F48F818823B1F03A
+S21403E3708130B1F488E917C0892F807599F09035FC
+S21403E38021F489E0E0E0F0E005C0983559F4E3E0D5
+S21403E390F0E089E080935700849105C08EE103C0C6
+S21403E3A081E001C080E01A821B829C831D828E83DB
+S21403E3B01F82C12C07E010E046C11A8288E08B83D7
+S21403E3C081E48C8386E58D8382E58E8389E48F835F
+S21403E3D083E5888780E589878FE58A8782E38B874D
+S21403E3E0C12C0BE010E02FC1EA81E059E33028F49A
+S21403E3F0F0E0E050FE4F808101C080E01A828B83FC
+S21403E400C12C03E010E01FC1CC24C3941A8219C1A7
+S21403E4108D81882321F0813021F488E924C08EE1A0
+S21403E42022C081E020C01A82E1E0F0E089E0809318
+S21403E430570084918B831C82C12C04E010E003C137
+S21403E4408B81803551F48C81883019F4E2E0F0E05A
+S21403E45006C089E0E0E0F0E003C0E3E0F0E089E036
+S21403E4608093570084911A82E5CF80EC8A83C12C6F
+S21403E47002E010E0812C912C5401E5C06A817B8177
+S21403E4808C819D8163D12B013C01440C551C661C79
+S21403E490771C1A82D5C0EA80FB80FE24EF24FE2474
+S21403E4A0233109F03CC0811440EC940643E0A406F3
+S21403E4B0B10478F423E0F401A0925B0020935700A4
+S21403E4C0E89507B600FCFDCF3FEF931AA30AB30AFD
+S21403E4D0EACF93018201DE011B968D919D9141E067
+S21403E4E00C01F80120935B0040935700E895112434
+S21403E4F00E5F1F4F2F4F3F4F82E0E81AF10869F770
+S21403E50095E0F20160925B0090935700E89507B69A
+S21403E51000FCFDCF81E180935700E89532C0D3011C
+S21403E520C201B695A795979587956C01FE013B9614
+S21403E530C15EDE4FF983E883CF51D14000E010E09F
+S21403E5400E151F05A1F0C15EDE4FE881F981CF519C
+S21403E550D1406191C15EDE4FF983E883CF51D1404C
+S21403E560C8018C0D9D1DF9D00F5F1F4FE9CF20E02A
+S21403E57030E0000F111F221F331F040D151D261D2B
+S21403E580371D1A82280139015BC08A819B8198272F
+S21403E590892798278C010D5F1F4F1A82243101F5B6
+S21403E5A08114F0EC9F06F3E0AF06B10408F446C00E
+S21403E5B0DE0111966BBEF2012791369112962C93CB
+S21403E5C01297FD01349613963C93139722E0420E5E
+S21403E5D0511C611C711C02971296009759F72BC0A9
+S21403E5E0FE0131969F01280F391FB301A20141BDD9
+S21403E5F0C52ED62EE72EFF24C2BC4F5F5F4F6F4F4C
+S21403E6007F4FF89AA0B5A28331962E173F0779F766
+S21403E610AC014150510960E070E04F5F5F4F6F4FB0
+S21403E6207F4F440E551E661E771EE3E0F0E0EC0FA8
+S21403E630FD1FE80FF91F1082C12C05C080EC8A83EA
+S21403E640C12C02E010E08BE198DDC25EDE4F8881CC
+S21403E650CE51D14092DD812F90DD802F8EDD85E176
+S21403E660C25EDE4FD880CE51D140D826D0268EE06B
+S21403E67084DDD126CE0101967C01080F191F0E15E5
+S21403E6801F0589F0F70121917F01C15EDE4F2883C4
+S21403E690CF51D140822F71DDC15EDE4F3881CF511D
+S21403E6A0D140D326ECCF8D2D68DDC25EDE4F488188
+S21403E6B0CE51D1404F5FC25EDE4F4883CE51D1402C
+S21403E6C000E010E0CC2009F4DCCD00008091C0000F
+S21403E6D08D7F8093C00081E180935700E895EE27F5
+S21403E6E0FF270994FFCF8BE1D82E21E0F7CD20E05A
+S21403E6F0F5CD1A0126E0F2CDA1E21A2EAA1BBB1B0A
+S21403E700FD010DC0AA1FBB1FEE1FFF1FA217B307F5
+S21403E710E407F50720F0A21BB30BE40BF50B661F0B
+S21403E720771F881F991F1A9469F7609570958095CF
+S21403E73090959B01AC01BD01CF010895EE0FFF1F1D
+S21403E740881F8BBF0790F691E02D199469279627AB
+S21403E75069277827872778270895262FF999FECFE4
+S21403E7601FBA92BD81BD20BD0FB6F894FA9AF99AE6
+S20E03E7700FBE01960895F894FFCF3C
+S20803E77A0F020A0078
+S80403E00018

cores/arduino/Arduino.h

@@ -0,0 +1,260 @@
+/*
+  Arduino.h - Main include file for the Arduino SDK
+  Copyright (c) 2005-2013 Arduino Team.  All right reserved.
+
+  This library is free software; you can redistribute it and/or
+  modify it under the terms of the GNU Lesser General Public
+  License as published by the Free Software Foundation; either
+  version 2.1 of the License, or (at your option) any later version.
+
+  This library 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
+  Lesser General Public License for more details.
+
+  You should have received a copy of the GNU Lesser General Public
+  License along with this library; if not, write to the Free Software
+  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
+*/
+
+#ifndef Arduino_h
+#define Arduino_h
+
+#include <stdlib.h>
+#include <stdbool.h>
+#include <string.h>
+#include <math.h>
+
+#include <avr/pgmspace.h>
+#include <avr/io.h>
+#include <avr/interrupt.h>
+
+#include "binary.h"
+
+#ifdef __cplusplus
+extern "C"{
+#endif
+
+void yield(void);
+
+#define HIGH 0x1
+#define LOW  0x0
+
+#define INPUT 0x0
+#define OUTPUT 0x1
+#define INPUT_PULLUP 0x2
+
+#define PI 3.1415926535897932384626433832795
+#define HALF_PI 1.5707963267948966192313216916398
+#define TWO_PI 6.283185307179586476925286766559
+#define DEG_TO_RAD 0.017453292519943295769236907684886
+#define RAD_TO_DEG 57.295779513082320876798154814105
+#define EULER 2.718281828459045235360287471352
+
+#define SERIAL  0x0
+#define DISPLAY 0x1
+
+#define LSBFIRST 0
+#define MSBFIRST 1
+
+#define CHANGE 1
+#define FALLING 2
+#define RISING 3
+
+#if defined(__AVR_ATtiny24__) || defined(__AVR_ATtiny44__) || defined(__AVR_ATtiny84__)
+  #define DEFAULT 0
+  #define EXTERNAL 1
+  #define INTERNAL1V1 2
+  #define INTERNAL INTERNAL1V1
+#elif defined(__AVR_ATtiny25__) || defined(__AVR_ATtiny45__) || defined(__AVR_ATtiny85__)
+  #define DEFAULT 0
+  #define EXTERNAL 4
+  #define INTERNAL1V1 8
+  #define INTERNAL INTERNAL1V1
+  #define INTERNAL2V56 9
+  #define INTERNAL2V56_EXTCAP 13
+#else  
+#if defined(__AVR_ATmega1280__) || defined(__AVR_ATmega2560__) || defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__) || defined(__AVR_ATmega644__) || defined(__AVR_ATmega644A__) || defined(__AVR_ATmega644P__) || defined(__AVR_ATmega644PA__)
+#define INTERNAL1V1 2
+#define INTERNAL2V56 3
+#else
+#define INTERNAL 3
+#endif
+#define DEFAULT 1
+#define EXTERNAL 0
+#endif
+
+// undefine stdlib's abs if encountered
+#ifdef abs
+#undef abs
+#endif
+
+#define min(a,b) ((a)<(b)?(a):(b))
+#define max(a,b) ((a)>(b)?(a):(b))
+#define abs(x) ((x)>0?(x):-(x))
+#define constrain(amt,low,high) ((amt)<(low)?(low):((amt)>(high)?(high):(amt)))
+#define round(x)     ((x)>=0?(long)((x)+0.5):(long)((x)-0.5))
+#define radians(deg) ((deg)*DEG_TO_RAD)
+#define degrees(rad) ((rad)*RAD_TO_DEG)
+#define sq(x) ((x)*(x))
+
+#define interrupts() sei()
+#define noInterrupts() cli()
+
+#define clockCyclesPerMicrosecond() ( F_CPU / 1000000L )
+#define clockCyclesToMicroseconds(a) ( (a) / clockCyclesPerMicrosecond() )
+#define microsecondsToClockCycles(a) ( (a) * clockCyclesPerMicrosecond() )
+
+#define lowByte(w) ((uint8_t) ((w) & 0xff))
+#define highByte(w) ((uint8_t) ((w) >> 8))
+
+#define bitRead(value, bit) (((value) >> (bit)) & 0x01)
+#define bitSet(value, bit) ((value) |= (1UL << (bit)))
+#define bitClear(value, bit) ((value) &= ~(1UL << (bit)))
+#define bitToggle(value, bit) ((value) ^= (1UL << (bit)))
+#define bitWrite(value, bit, bitvalue) ((bitvalue) ? bitSet(value, bit) : bitClear(value, bit))
+
+// avr-libc defines _NOP() since 1.6.2
+#ifndef _NOP
+#define _NOP() do { __asm__ volatile ("nop"); } while (0)
+#endif
+
+typedef unsigned int word;
+
+#define bit(b) (1UL << (b))
+
+typedef bool boolean;
+typedef uint8_t byte;
+
+void init(void);
+void initVariant(void);
+
+int atexit(void (*func)()) __attribute__((weak));
+
+void pinMode(uint8_t pin, uint8_t mode);
+void digitalWrite(uint8_t pin, uint8_t val);
+int digitalRead(uint8_t pin);
+int analogRead(uint8_t pin);
+void analogReference(uint8_t mode);
+void analogWrite(uint8_t pin, int val);
+
+unsigned long millis(void);
+unsigned long micros(void);
+void delay(unsigned long ms);
+void delayMicroseconds(unsigned int us);
+unsigned long pulseIn(uint8_t pin, uint8_t state, unsigned long timeout);
+unsigned long pulseInLong(uint8_t pin, uint8_t state, unsigned long timeout);
+
+void shiftOut(uint8_t dataPin, uint8_t clockPin, uint8_t bitOrder, uint8_t val);
+uint8_t shiftIn(uint8_t dataPin, uint8_t clockPin, uint8_t bitOrder);
+
+void attachInterrupt(uint8_t interruptNum, void (*userFunc)(void), int mode);
+void detachInterrupt(uint8_t interruptNum);
+
+void setup(void);
+void loop(void);
+
+// Get the bit location within the hardware port of the given virtual pin.
+// This comes from the pins_*.c file for the active board configuration.
+
+#define analogInPinToBit(P) (P)
+
+// On the ATmega1280, the addresses of some of the port registers are
+// greater than 255, so we can't store them in uint8_t's.
+extern const uint16_t PROGMEM port_to_mode_PGM[];
+extern const uint16_t PROGMEM port_to_input_PGM[];
+extern const uint16_t PROGMEM port_to_output_PGM[];
+
+extern const uint8_t PROGMEM digital_pin_to_port_PGM[];
+// extern const uint8_t PROGMEM digital_pin_to_bit_PGM[];
+extern const uint8_t PROGMEM digital_pin_to_bit_mask_PGM[];
+extern const uint8_t PROGMEM digital_pin_to_timer_PGM[];
+
+// Get the bit location within the hardware port of the given virtual pin.
+// This comes from the pins_*.c file for the active board configuration.
+// 
+// These perform slightly better as macros compared to inline functions
+//
+#define digitalPinToPort(P) ( pgm_read_byte( digital_pin_to_port_PGM + (P) ) )
+#define digitalPinToBitMask(P) ( pgm_read_byte( digital_pin_to_bit_mask_PGM + (P) ) )
+#define digitalPinToTimer(P) ( pgm_read_byte( digital_pin_to_timer_PGM + (P) ) )
+#define analogInPinToBit(P) (P)
+#define portOutputRegister(P) ( (volatile uint8_t *)( pgm_read_word( port_to_output_PGM + (P))) )
+#define portInputRegister(P) ( (volatile uint8_t *)( pgm_read_word( port_to_input_PGM + (P))) )
+#define portModeRegister(P) ( (volatile uint8_t *)( pgm_read_word( port_to_mode_PGM + (P))) )
+
+#define NOT_A_PIN 0
+#define NOT_A_PORT 0
+
+#define NOT_AN_INTERRUPT -1
+
+#ifdef ARDUINO_MAIN
+#define PA 1
+#define PB 2
+#define PC 3
+#define PD 4
+#define PE 5
+#define PF 6
+#define PG 7
+#define PH 8
+#define PJ 10
+#define PK 11
+#define PL 12
+#endif
+
+#define NOT_ON_TIMER 0
+#define TIMER0A 1
+#define TIMER0B 2
+#define TIMER1A 3
+#define TIMER1B 4
+#define TIMER1C 5
+#define TIMER2  6
+#define TIMER2A 7
+#define TIMER2B 8
+
+#define TIMER3A 9
+#define TIMER3B 10
+#define TIMER3C 11
+#define TIMER4A 12
+#define TIMER4B 13
+#define TIMER4C 14
+#define TIMER4D 15
+#define TIMER5A 16
+#define TIMER5B 17
+#define TIMER5C 18
+
+#ifdef __cplusplus
+} // extern "C"
+#endif
+
+#ifdef __cplusplus
+#include "WCharacter.h"
+#include "WString.h"
+#include "HardwareSerial.h"
+#include "USBAPI.h"
+#if defined(HAVE_HWSERIAL0) && defined(HAVE_CDCSERIAL)
+#error "Targets with both UART0 and CDC serial not supported"
+#endif
+
+uint16_t makeWord(uint16_t w);
+uint16_t makeWord(byte h, byte l);
+
+#define word(...) makeWord(__VA_ARGS__)
+
+unsigned long pulseIn(uint8_t pin, uint8_t state, unsigned long timeout = 1000000L);
+unsigned long pulseInLong(uint8_t pin, uint8_t state, unsigned long timeout = 1000000L);
+
+void tone(uint8_t _pin, unsigned int frequency, unsigned long duration = 0);
+void noTone(uint8_t _pin);
+
+// WMath prototypes
+long random(long);
+long random(long, long);
+void randomSeed(unsigned long);
+long map(long, long, long, long, long);
+
+#endif
+
+#include "pins_arduino.h"
+
+#endif

cores/arduino/CDC.cpp

@@ -0,0 +1,310 @@
+
+
+/* Copyright (c) 2011, Peter Barrett  
+**  
+** Permission to use, copy, modify, and/or distribute this software for  
+** any purpose with or without fee is hereby granted, provided that the  
+** above copyright notice and this permission notice appear in all copies.  
+** 
+** THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL  
+** WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED  
+** WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR  
+** BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES  
+** OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS,  
+** WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION,  
+** ARISING OUT OF OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS  
+** SOFTWARE.  
+*/
+
+#include "USBAPI.h"
+#include <avr/wdt.h>
+#include <util/atomic.h>
+
+#if defined(USBCON)
+
+#ifndef CDC_ENABLED
+
+#warning "! Disabled serial console via USB (CDC)!"
+#warning "! With this change you'll have to use the Arduino's reset button/pin to flash (upload)!"
+
+#else // CDC not disabled
+
+typedef struct
+{
+	u32	dwDTERate;
+	u8	bCharFormat;
+	u8 	bParityType;
+	u8 	bDataBits;
+	u8	lineState;
+} LineInfo;
+
+static volatile LineInfo _usbLineInfo = { 57600, 0x00, 0x00, 0x00, 0x00 };
+static volatile int32_t breakValue = -1;
+
+static u8 wdtcsr_save;
+
+#define WEAK __attribute__ ((weak))
+
+extern const CDCDescriptor _cdcInterface PROGMEM;
+const CDCDescriptor _cdcInterface =
+{
+	D_IAD(0,2,CDC_COMMUNICATION_INTERFACE_CLASS,CDC_ABSTRACT_CONTROL_MODEL,0),
+
+	//	CDC communication interface
+	D_INTERFACE(CDC_ACM_INTERFACE,1,CDC_COMMUNICATION_INTERFACE_CLASS,CDC_ABSTRACT_CONTROL_MODEL,0),
+	D_CDCCS(CDC_HEADER,0x10,0x01),								// Header (1.10 bcd)
+	D_CDCCS(CDC_CALL_MANAGEMENT,1,1),							// Device handles call management (not)
+	D_CDCCS4(CDC_ABSTRACT_CONTROL_MANAGEMENT,6),				// SET_LINE_CODING, GET_LINE_CODING, SET_CONTROL_LINE_STATE supported
+	D_CDCCS(CDC_UNION,CDC_ACM_INTERFACE,CDC_DATA_INTERFACE),	// Communication interface is master, data interface is slave 0
+	D_ENDPOINT(USB_ENDPOINT_IN (CDC_ENDPOINT_ACM),USB_ENDPOINT_TYPE_INTERRUPT,0x10,0x40),
+
+	//	CDC data interface
+	D_INTERFACE(CDC_DATA_INTERFACE,2,CDC_DATA_INTERFACE_CLASS,0,0),
+	D_ENDPOINT(USB_ENDPOINT_OUT(CDC_ENDPOINT_OUT),USB_ENDPOINT_TYPE_BULK,USB_EP_SIZE,0),
+	D_ENDPOINT(USB_ENDPOINT_IN (CDC_ENDPOINT_IN ),USB_ENDPOINT_TYPE_BULK,USB_EP_SIZE,0)
+};
+
+bool isLUFAbootloader()
+{
+	return pgm_read_word(FLASHEND - 1) == NEW_LUFA_SIGNATURE;
+}
+
+int CDC_GetInterface(u8* interfaceNum)
+{
+	interfaceNum[0] += 2;	// uses 2
+	return USB_SendControl(TRANSFER_PGM,&_cdcInterface,sizeof(_cdcInterface));
+}
+
+bool CDC_Setup(USBSetup& setup)
+{
+	u8 r = setup.bRequest;
+	u8 requestType = setup.bmRequestType;
+
+	if (REQUEST_DEVICETOHOST_CLASS_INTERFACE == requestType)
+	{
+		if (CDC_GET_LINE_CODING == r)
+		{
+			USB_SendControl(0,(void*)&_usbLineInfo,7);
+			return true;
+		}
+	}
+
+	if (REQUEST_HOSTTODEVICE_CLASS_INTERFACE == requestType)
+	{
+		if (CDC_SEND_BREAK == r)
+		{
+			breakValue = ((uint16_t)setup.wValueH << 8) | setup.wValueL;
+		}
+
+		if (CDC_SET_LINE_CODING == r)
+		{
+			USB_RecvControl((void*)&_usbLineInfo,7);
+		}
+
+		if (CDC_SET_CONTROL_LINE_STATE == r)
+		{
+			_usbLineInfo.lineState = setup.wValueL;
+
+			// auto-reset into the bootloader is triggered when the port, already 
+			// open at 1200 bps, is closed.  this is the signal to start the watchdog
+			// with a relatively long period so it can finish housekeeping tasks
+			// like servicing endpoints before the sketch ends
+
+			uint16_t magic_key_pos = MAGIC_KEY_POS;
+
+// If we don't use the new RAMEND directly, check manually if we have a newer bootloader.
+// This is used to keep compatible with the old leonardo bootloaders.
+// You are still able to set the magic key position manually to RAMEND-1 to save a few bytes for this check.
+#if MAGIC_KEY_POS != (RAMEND-1)
+			// For future boards save the key in the inproblematic RAMEND
+			// Which is reserved for the main() return value (which will never return)
+			if (isLUFAbootloader()) {
+				// hooray, we got a new bootloader!
+				magic_key_pos = (RAMEND-1);
+			}
+#endif
+
+			// We check DTR state to determine if host port is open (bit 0 of lineState).
+			if (1200 == _usbLineInfo.dwDTERate && (_usbLineInfo.lineState & 0x01) == 0)
+			{
+#if MAGIC_KEY_POS != (RAMEND-1)
+				// Backup ram value if its not a newer bootloader and it hasn't already been saved.
+				// This should avoid memory corruption at least a bit, not fully
+				if (magic_key_pos != (RAMEND-1) && *(uint16_t *)magic_key_pos != MAGIC_KEY) {
+					*(uint16_t *)(RAMEND-1) = *(uint16_t *)magic_key_pos;
+				}
+#endif
+				// Store boot key
+				*(uint16_t *)magic_key_pos = MAGIC_KEY;
+				// Save the watchdog state in case the reset is aborted.
+				wdtcsr_save = WDTCSR;
+				wdt_enable(WDTO_120MS);
+			}
+			else if (*(uint16_t *)magic_key_pos == MAGIC_KEY)
+			{
+				// Most OSs do some intermediate steps when configuring ports and DTR can
+				// twiggle more than once before stabilizing.
+				// To avoid spurious resets we set the watchdog to 120ms and eventually
+				// cancel if DTR goes back high.
+				// Cancellation is only done if an auto-reset was started, which is
+				// indicated by the magic key having been set.
+
+				wdt_reset();
+				// Restore the watchdog state in case the sketch was using it.
+				WDTCSR |= (1<<WDCE) | (1<<WDE);
+				WDTCSR = wdtcsr_save;
+#if MAGIC_KEY_POS != (RAMEND-1)
+				// Restore backed up (old bootloader) magic key data
+				if (magic_key_pos != (RAMEND-1)) {
+					*(uint16_t *)magic_key_pos = *(uint16_t *)(RAMEND-1);
+				} else
+#endif
+				{
+				// Clean up RAMEND key
+					*(uint16_t *)magic_key_pos = 0x0000;
+				}
+			}
+		}
+		return true;
+	}
+	return false;
+}
+
+
+void Serial_::begin(unsigned long /* baud_count */)
+{
+	peek_buffer = -1;
+}
+
+void Serial_::begin(unsigned long /* baud_count */, byte /* config */)
+{
+	peek_buffer = -1;
+}
+
+void Serial_::end(void)
+{
+}
+
+int Serial_::available(void)
+{
+	if (peek_buffer >= 0) {
+		return 1 + USB_Available(CDC_RX);
+	}
+	return USB_Available(CDC_RX);
+}
+
+int Serial_::peek(void)
+{
+	if (peek_buffer < 0)
+		peek_buffer = USB_Recv(CDC_RX);
+	return peek_buffer;
+}
+
+int Serial_::read(void)
+{
+	if (peek_buffer >= 0) {
+		int c = peek_buffer;
+		peek_buffer = -1;
+		return c;
+	}
+	return USB_Recv(CDC_RX);
+}
+
+int Serial_::availableForWrite(void)
+{
+	return USB_SendSpace(CDC_TX);
+}
+
+void Serial_::flush(void)
+{
+	USB_Flush(CDC_TX);
+}
+
+size_t Serial_::write(uint8_t c)
+{
+	return write(&c, 1);
+}
+
+size_t Serial_::write(const uint8_t *buffer, size_t size)
+{
+	/* only try to send bytes if the high-level CDC connection itself 
+	 is open (not just the pipe) - the OS should set lineState when the port
+	 is opened and clear lineState when the port is closed.
+	 bytes sent before the user opens the connection or after
+	 the connection is closed are lost - just like with a UART. */
+	
+	// TODO - ZE - check behavior on different OSes and test what happens if an
+	// open connection isn't broken cleanly (cable is yanked out, host dies
+	// or locks up, or host virtual serial port hangs)
+	if (_usbLineInfo.lineState > 0)	{
+		int r = USB_Send(CDC_TX,buffer,size);
+		if (r > 0) {
+			return r;
+		} else {
+			setWriteError();
+			return 0;
+		}
+	}
+	setWriteError();
+	return 0;
+}
+
+// This operator is a convenient way for a sketch to check whether the
+// port has actually been configured and opened by the host (as opposed
+// to just being connected to the host).  It can be used, for example, in 
+// setup() before printing to ensure that an application on the host is
+// actually ready to receive and display the data.
+// We add a short delay before returning to fix a bug observed by Federico
+// where the port is configured (lineState != 0) but not quite opened.
+Serial_::operator bool() {
+	bool result = false;
+	if (_usbLineInfo.lineState > 0) 
+		result = true;
+	delay(10);
+	return result;
+}
+
+unsigned long Serial_::baud() {
+	// Disable interrupts while reading a multi-byte value
+	uint32_t baudrate;
+	ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
+		baudrate =  _usbLineInfo.dwDTERate;
+	}
+	return baudrate;
+}
+
+uint8_t Serial_::stopbits() {
+	return _usbLineInfo.bCharFormat;
+}
+
+uint8_t Serial_::paritytype() {
+	return _usbLineInfo.bParityType;
+}
+
+uint8_t Serial_::numbits() {
+	return _usbLineInfo.bDataBits;
+}
+
+bool Serial_::dtr() {
+	return _usbLineInfo.lineState & 0x1;
+}
+
+bool Serial_::rts() {
+	return _usbLineInfo.lineState & 0x2;
+}
+
+int32_t Serial_::readBreak() {
+	int32_t ret;
+	// Disable IRQs while reading and clearing breakValue to make
+	// sure we don't overwrite a value just set by the ISR.
+	ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
+		ret = breakValue;
+		breakValue = -1;
+	}
+	return ret;
+}
+
+Serial_ Serial;
+
+#endif /* if defined(CDC_ENABLED) */
+#endif /* if defined(USBCON) */

cores/arduino/Client.h

@@ -0,0 +1,45 @@
+/*
+  Client.h - Base class that provides Client
+  Copyright (c) 2011 Adrian McEwen.  All right reserved.
+
+  This library is free software; you can redistribute it and/or
+  modify it under the terms of the GNU Lesser General Public
+  License as published by the Free Software Foundation; either
+  version 2.1 of the License, or (at your option) any later version.
+
+  This library 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
+  Lesser General Public License for more details.
+
+  You should have received a copy of the GNU Lesser General Public
+  License along with this library; if not, write to the Free Software
+  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
+*/
+
+#ifndef client_h
+#define client_h
+#include "Print.h"
+#include "Stream.h"
+#include "IPAddress.h"
+
+class Client : public Stream {
+
+public:
+  virtual int connect(IPAddress ip, uint16_t port) =0;
+  virtual int connect(const char *host, uint16_t port) =0;
+  virtual size_t write(uint8_t) =0;
+  virtual size_t write(const uint8_t *buf, size_t size) =0;
+  virtual int available() = 0;
+  virtual int read() = 0;
+  virtual int read(uint8_t *buf, size_t size) = 0;
+  virtual int peek() = 0;
+  virtual void flush() = 0;
+  virtual void stop() = 0;
+  virtual uint8_t connected() = 0;
+  virtual operator bool() = 0;
+protected:
+  uint8_t* rawIPAddress(IPAddress& addr) { return addr.raw_address(); };
+};
+
+#endif

cores/arduino/HardwareSerial.cpp

@@ -0,0 +1,281 @@
+/*
+  HardwareSerial.cpp - Hardware serial library for Wiring
+  Copyright (c) 2006 Nicholas Zambetti.  All right reserved.
+
+  This library is free software; you can redistribute it and/or
+  modify it under the terms of the GNU Lesser General Public
+  License as published by the Free Software Foundation; either
+  version 2.1 of the License, or (at your option) any later version.
+
+  This library 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
+  Lesser General Public License for more details.
+
+  You should have received a copy of the GNU Lesser General Public
+  License along with this library; if not, write to the Free Software
+  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
+  
+  Modified 23 November 2006 by David A. Mellis
+  Modified 28 September 2010 by Mark Sproul
+  Modified 14 August 2012 by Alarus
+  Modified 3 December 2013 by Matthijs Kooijman
+*/
+
+#include <stdlib.h>
+#include <stdio.h>
+#include <string.h>
+#include <inttypes.h>
+#include <util/atomic.h>
+#include "Arduino.h"
+
+#include "HardwareSerial.h"
+#include "HardwareSerial_private.h"
+
+// this next line disables the entire HardwareSerial.cpp, 
+// this is so I can support Attiny series and any other chip without a uart
+#if defined(HAVE_HWSERIAL0) || defined(HAVE_HWSERIAL1) || defined(HAVE_HWSERIAL2) || defined(HAVE_HWSERIAL3)
+
+// SerialEvent functions are weak, so when the user doesn't define them,
+// the linker just sets their address to 0 (which is checked below).
+// The Serialx_available is just a wrapper around Serialx.available(),
+// but we can refer to it weakly so we don't pull in the entire
+// HardwareSerial instance if the user doesn't also refer to it.
+#if defined(HAVE_HWSERIAL0)
+  void serialEvent() __attribute__((weak));
+  bool Serial0_available() __attribute__((weak));
+#endif
+
+#if defined(HAVE_HWSERIAL1)
+  void serialEvent1() __attribute__((weak));
+  bool Serial1_available() __attribute__((weak));
+#endif
+
+#if defined(HAVE_HWSERIAL2)
+  void serialEvent2() __attribute__((weak));
+  bool Serial2_available() __attribute__((weak));
+#endif
+
+#if defined(HAVE_HWSERIAL3)
+  void serialEvent3() __attribute__((weak));
+  bool Serial3_available() __attribute__((weak));
+#endif
+
+void serialEventRun(void)
+{
+#if defined(HAVE_HWSERIAL0)
+  if (Serial0_available && serialEvent && Serial0_available()) serialEvent();
+#endif
+#if defined(HAVE_HWSERIAL1)
+  if (Serial1_available && serialEvent1 && Serial1_available()) serialEvent1();
+#endif
+#if defined(HAVE_HWSERIAL2)
+  if (Serial2_available && serialEvent2 && Serial2_available()) serialEvent2();
+#endif
+#if defined(HAVE_HWSERIAL3)
+  if (Serial3_available && serialEvent3 && Serial3_available()) serialEvent3();
+#endif
+}
+
+// macro to guard critical sections when needed for large TX buffer sizes
+#if (SERIAL_TX_BUFFER_SIZE>256)
+#define TX_BUFFER_ATOMIC ATOMIC_BLOCK(ATOMIC_RESTORESTATE)
+#else
+#define TX_BUFFER_ATOMIC
+#endif
+
+// Actual interrupt handlers //////////////////////////////////////////////////////////////
+
+void HardwareSerial::_tx_udr_empty_irq(void)
+{
+  // If interrupts are enabled, there must be more data in the output
+  // buffer. Send the next byte
+  unsigned char c = _tx_buffer[_tx_buffer_tail];
+  _tx_buffer_tail = (_tx_buffer_tail + 1) % SERIAL_TX_BUFFER_SIZE;
+
+  *_udr = c;
+
+  // clear the TXC bit -- "can be cleared by writing a one to its bit
+  // location". This makes sure flush() won't return until the bytes
+  // actually got written. Other r/w bits are preserved, and zeroes
+  // written to the rest.
+
+#ifdef MPCM0
+  *_ucsra = ((*_ucsra) & ((1 << U2X0) | (1 << MPCM0))) | (1 << TXC0);
+#else
+  *_ucsra = ((*_ucsra) & ((1 << U2X0) | (1 << TXC0)));
+#endif
+
+  if (_tx_buffer_head == _tx_buffer_tail) {
+    // Buffer empty, so disable interrupts
+    cbi(*_ucsrb, UDRIE0);
+  }
+}
+
+// Public Methods //////////////////////////////////////////////////////////////
+
+void HardwareSerial::begin(unsigned long baud, byte config)
+{
+  // Try u2x mode first
+  uint16_t baud_setting = (F_CPU / 4 / baud - 1) / 2;
+  *_ucsra = 1 << U2X0;
+
+  // hardcoded exception for 57600 for compatibility with the bootloader
+  // shipped with the Duemilanove and previous boards and the firmware
+  // on the 8U2 on the Uno and Mega 2560. Also, The baud_setting cannot
+  // be > 4095, so switch back to non-u2x mode if the baud rate is too
+  // low.
+  if (((F_CPU == 16000000UL) && (baud == 57600)) || (baud_setting >4095))
+  {
+    *_ucsra = 0;
+    baud_setting = (F_CPU / 8 / baud - 1) / 2;
+  }
+
+  // assign the baud_setting, a.k.a. ubrr (USART Baud Rate Register)
+  *_ubrrh = baud_setting >> 8;
+  *_ubrrl = baud_setting;
+
+  _written = false;
+
+  //set the data bits, parity, and stop bits
+#if defined(__AVR_ATmega8__)
+  config |= 0x80; // select UCSRC register (shared with UBRRH)
+#endif
+  *_ucsrc = config;
+  
+  sbi(*_ucsrb, RXEN0);
+  sbi(*_ucsrb, TXEN0);
+  sbi(*_ucsrb, RXCIE0);
+  cbi(*_ucsrb, UDRIE0);
+}
+
+void HardwareSerial::end()
+{
+  // wait for transmission of outgoing data
+  flush();
+
+  cbi(*_ucsrb, RXEN0);
+  cbi(*_ucsrb, TXEN0);
+  cbi(*_ucsrb, RXCIE0);
+  cbi(*_ucsrb, UDRIE0);
+  
+  // clear any received data
+  _rx_buffer_head = _rx_buffer_tail;
+}
+
+int HardwareSerial::available(void)
+{
+  return ((unsigned int)(SERIAL_RX_BUFFER_SIZE + _rx_buffer_head - _rx_buffer_tail)) % SERIAL_RX_BUFFER_SIZE;
+}
+
+int HardwareSerial::peek(void)
+{
+  if (_rx_buffer_head == _rx_buffer_tail) {
+    return -1;
+  } else {
+    return _rx_buffer[_rx_buffer_tail];
+  }
+}
+
+int HardwareSerial::read(void)
+{
+  // if the head isn't ahead of the tail, we don't have any characters
+  if (_rx_buffer_head == _rx_buffer_tail) {
+    return -1;
+  } else {
+    unsigned char c = _rx_buffer[_rx_buffer_tail];
+    _rx_buffer_tail = (rx_buffer_index_t)(_rx_buffer_tail + 1) % SERIAL_RX_BUFFER_SIZE;
+    return c;
+  }
+}
+
+int HardwareSerial::availableForWrite(void)
+{
+  tx_buffer_index_t head;
+  tx_buffer_index_t tail;
+
+  TX_BUFFER_ATOMIC {
+    head = _tx_buffer_head;
+    tail = _tx_buffer_tail;
+  }
+  if (head >= tail) return SERIAL_TX_BUFFER_SIZE - 1 - head + tail;
+  return tail - head - 1;
+}
+
+void HardwareSerial::flush()
+{
+  // If we have never written a byte, no need to flush. This special
+  // case is needed since there is no way to force the TXC (transmit
+  // complete) bit to 1 during initialization
+  if (!_written)
+    return;
+
+  while (bit_is_set(*_ucsrb, UDRIE0) || bit_is_clear(*_ucsra, TXC0)) {
+    if (bit_is_clear(SREG, SREG_I) && bit_is_set(*_ucsrb, UDRIE0))
+	// Interrupts are globally disabled, but the DR empty
+	// interrupt should be enabled, so poll the DR empty flag to
+	// prevent deadlock
+	if (bit_is_set(*_ucsra, UDRE0))
+	  _tx_udr_empty_irq();
+  }
+  // If we get here, nothing is queued anymore (DRIE is disabled) and
+  // the hardware finished transmission (TXC is set).
+}
+
+size_t HardwareSerial::write(uint8_t c)
+{
+  _written = true;
+  // If the buffer and the data register is empty, just write the byte
+  // to the data register and be done. This shortcut helps
+  // significantly improve the effective datarate at high (>
+  // 500kbit/s) bitrates, where interrupt overhead becomes a slowdown.
+  if (_tx_buffer_head == _tx_buffer_tail && bit_is_set(*_ucsra, UDRE0)) {
+    // If TXC is cleared before writing UDR and the previous byte
+    // completes before writing to UDR, TXC will be set but a byte
+    // is still being transmitted causing flush() to return too soon.
+    // So writing UDR must happen first.
+    // Writing UDR and clearing TC must be done atomically, otherwise
+    // interrupts might delay the TXC clear so the byte written to UDR
+    // is transmitted (setting TXC) before clearing TXC. Then TXC will
+    // be cleared when no bytes are left, causing flush() to hang
+    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
+      *_udr = c;
+#ifdef MPCM0
+      *_ucsra = ((*_ucsra) & ((1 << U2X0) | (1 << MPCM0))) | (1 << TXC0);
+#else
+      *_ucsra = ((*_ucsra) & ((1 << U2X0) | (1 << TXC0)));
+#endif
+    }
+    return 1;
+  }
+  tx_buffer_index_t i = (_tx_buffer_head + 1) % SERIAL_TX_BUFFER_SIZE;
+	
+  // If the output buffer is full, there's nothing for it other than to 
+  // wait for the interrupt handler to empty it a bit
+  while (i == _tx_buffer_tail) {
+    if (bit_is_clear(SREG, SREG_I)) {
+      // Interrupts are disabled, so we'll have to poll the data
+      // register empty flag ourselves. If it is set, pretend an
+      // interrupt has happened and call the handler to free up
+      // space for us.
+      if(bit_is_set(*_ucsra, UDRE0))
+	_tx_udr_empty_irq();
+    } else {
+      // nop, the interrupt handler will free up space for us
+    }
+  }
+
+  _tx_buffer[_tx_buffer_head] = c;
+
+  // make atomic to prevent execution of ISR between setting the
+  // head pointer and setting the interrupt flag resulting in buffer
+  // retransmission
+  ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
+    _tx_buffer_head = i;
+    sbi(*_ucsrb, UDRIE0);
+  }
+  
+  return 1;
+}
+
+#endif // whole file

cores/arduino/HardwareSerial.h

@@ -0,0 +1,161 @@
+/*
+  HardwareSerial.h - Hardware serial library for Wiring
+  Copyright (c) 2006 Nicholas Zambetti.  All right reserved.
+
+  This library is free software; you can redistribute it and/or
+  modify it under the terms of the GNU Lesser General Public
+  License as published by the Free Software Foundation; either
+  version 2.1 of the License, or (at your option) any later version.
+
+  This library 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
+  Lesser General Public License for more details.
+
+  You should have received a copy of the GNU Lesser General Public
+  License along with this library; if not, write to the Free Software
+  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
+
+  Modified 28 September 2010 by Mark Sproul
+  Modified 14 August 2012 by Alarus
+  Modified 3 December 2013 by Matthijs Kooijman
+*/
+
+#ifndef HardwareSerial_h
+#define HardwareSerial_h
+
+#include <inttypes.h>
+
+#include "Stream.h"
+
+// Define constants and variables for buffering incoming serial data.  We're
+// using a ring buffer (I think), in which head is the index of the location
+// to which to write the next incoming character and tail is the index of the
+// location from which to read.
+// NOTE: a "power of 2" buffer size is recommended to dramatically
+//       optimize all the modulo operations for ring buffers.
+// WARNING: When buffer sizes are increased to > 256, the buffer index
+// variables are automatically increased in size, but the extra
+// atomicity guards needed for that are not implemented. This will
+// often work, but occasionally a race condition can occur that makes
+// Serial behave erratically. See https://github.com/arduino/Arduino/issues/2405
+#if !defined(SERIAL_TX_BUFFER_SIZE)
+#if ((RAMEND - RAMSTART) < 1023)
+#define SERIAL_TX_BUFFER_SIZE 16
+#else
+#define SERIAL_TX_BUFFER_SIZE 64
+#endif
+#endif
+#if !defined(SERIAL_RX_BUFFER_SIZE)
+#if ((RAMEND - RAMSTART) < 1023)
+#define SERIAL_RX_BUFFER_SIZE 16
+#else
+#define SERIAL_RX_BUFFER_SIZE 64
+#endif
+#endif
+#if (SERIAL_TX_BUFFER_SIZE>256)
+typedef uint16_t tx_buffer_index_t;
+#else
+typedef uint8_t tx_buffer_index_t;
+#endif
+#if  (SERIAL_RX_BUFFER_SIZE>256)
+typedef uint16_t rx_buffer_index_t;
+#else
+typedef uint8_t rx_buffer_index_t;
+#endif
+
+// Define config for Serial.begin(baud, config);
+#define SERIAL_5N1 0x00
+#define SERIAL_6N1 0x02
+#define SERIAL_7N1 0x04
+#define SERIAL_8N1 0x06
+#define SERIAL_5N2 0x08
+#define SERIAL_6N2 0x0A
+#define SERIAL_7N2 0x0C
+#define SERIAL_8N2 0x0E
+#define SERIAL_5E1 0x20
+#define SERIAL_6E1 0x22
+#define SERIAL_7E1 0x24
+#define SERIAL_8E1 0x26
+#define SERIAL_5E2 0x28
+#define SERIAL_6E2 0x2A
+#define SERIAL_7E2 0x2C
+#define SERIAL_8E2 0x2E
+#define SERIAL_5O1 0x30
+#define SERIAL_6O1 0x32
+#define SERIAL_7O1 0x34
+#define SERIAL_8O1 0x36
+#define SERIAL_5O2 0x38
+#define SERIAL_6O2 0x3A
+#define SERIAL_7O2 0x3C
+#define SERIAL_8O2 0x3E
+
+class HardwareSerial : public Stream
+{
+  protected:
+    volatile uint8_t * const _ubrrh;
+    volatile uint8_t * const _ubrrl;
+    volatile uint8_t * const _ucsra;
+    volatile uint8_t * const _ucsrb;
+    volatile uint8_t * const _ucsrc;
+    volatile uint8_t * const _udr;
+    // Has any byte been written to the UART since begin()
+    bool _written;
+
+    volatile rx_buffer_index_t _rx_buffer_head;
+    volatile rx_buffer_index_t _rx_buffer_tail;
+    volatile tx_buffer_index_t _tx_buffer_head;
+    volatile tx_buffer_index_t _tx_buffer_tail;
+
+    // Don't put any members after these buffers, since only the first
+    // 32 bytes of this struct can be accessed quickly using the ldd
+    // instruction.
+    unsigned char _rx_buffer[SERIAL_RX_BUFFER_SIZE];
+    unsigned char _tx_buffer[SERIAL_TX_BUFFER_SIZE];
+
+  public:
+    inline HardwareSerial(
+      volatile uint8_t *ubrrh, volatile uint8_t *ubrrl,
+      volatile uint8_t *ucsra, volatile uint8_t *ucsrb,
+      volatile uint8_t *ucsrc, volatile uint8_t *udr);
+    void begin(unsigned long baud) { begin(baud, SERIAL_8N1); }
+    void begin(unsigned long, uint8_t);
+    void end();
+    virtual int available(void);
+    virtual int peek(void);
+    virtual int read(void);
+    virtual int availableForWrite(void);
+    virtual void flush(void);
+    virtual size_t write(uint8_t);
+    inline size_t write(unsigned long n) { return write((uint8_t)n); }
+    inline size_t write(long n) { return write((uint8_t)n); }
+    inline size_t write(unsigned int n) { return write((uint8_t)n); }
+    inline size_t write(int n) { return write((uint8_t)n); }
+    using Print::write; // pull in write(str) and write(buf, size) from Print
+    operator bool() { return true; }
+
+    // Interrupt handlers - Not intended to be called externally
+    inline void _rx_complete_irq(void);
+    void _tx_udr_empty_irq(void);
+};
+
+#if defined(UBRRH) || defined(UBRR0H)
+  extern HardwareSerial Serial;
+  #define HAVE_HWSERIAL0
+#endif
+#if defined(UBRR1H)
+  extern HardwareSerial Serial1;
+  #define HAVE_HWSERIAL1
+#endif
+#if defined(UBRR2H)
+  extern HardwareSerial Serial2;
+  #define HAVE_HWSERIAL2
+#endif
+#if defined(UBRR3H)
+  extern HardwareSerial Serial3;
+  #define HAVE_HWSERIAL3
+#endif
+
+extern void serialEventRun(void) __attribute__((weak));
+
+#endif

cores/arduino/HardwareSerial0.cpp

@@ -0,0 +1,79 @@
+/*
+  HardwareSerial0.cpp - Hardware serial library for Wiring
+  Copyright (c) 2006 Nicholas Zambetti.  All right reserved.
+
+  This library is free software; you can redistribute it and/or
+  modify it under the terms of the GNU Lesser General Public
+  License as published by the Free Software Foundation; either
+  version 2.1 of the License, or (at your option) any later version.
+
+  This library 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
+  Lesser General Public License for more details.
+
+  You should have received a copy of the GNU Lesser General Public
+  License along with this library; if not, write to the Free Software
+  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
+
+  Modified 23 November 2006 by David A. Mellis
+  Modified 28 September 2010 by Mark Sproul
+  Modified 14 August 2012 by Alarus
+  Modified 3 December 2013 by Matthijs Kooijman
+*/
+
+#include "Arduino.h"
+#include "HardwareSerial.h"
+#include "HardwareSerial_private.h"
+
+// Each HardwareSerial is defined in its own file, since the linker pulls
+// in the entire file when any element inside is used. --gc-sections can
+// additionally cause unused symbols to be dropped, but ISRs have the
+// "used" attribute so are never dropped and they keep the
+// HardwareSerial instance in as well. Putting each instance in its own
+// file prevents the linker from pulling in any unused instances in the
+// first place.
+
+#if defined(HAVE_HWSERIAL0)
+
+#if defined(USART_RX_vect)
+  ISR(USART_RX_vect)
+#elif defined(USART0_RX_vect)
+  ISR(USART0_RX_vect)
+#elif defined(USART_RXC_vect)
+  ISR(USART_RXC_vect) // ATmega8
+#else
+  #error "Don't know what the Data Received vector is called for Serial"
+#endif
+  {
+    Serial._rx_complete_irq();
+  }
+
+#if defined(UART0_UDRE_vect)
+ISR(UART0_UDRE_vect)
+#elif defined(UART_UDRE_vect)
+ISR(UART_UDRE_vect)
+#elif defined(USART0_UDRE_vect)
+ISR(USART0_UDRE_vect)
+#elif defined(USART_UDRE_vect)
+ISR(USART_UDRE_vect)
+#else
+  #error "Don't know what the Data Register Empty vector is called for Serial"
+#endif
+{
+  Serial._tx_udr_empty_irq();
+}
+
+#if defined(UBRRH) && defined(UBRRL)
+  HardwareSerial Serial(&UBRRH, &UBRRL, &UCSRA, &UCSRB, &UCSRC, &UDR);
+#else
+  HardwareSerial Serial(&UBRR0H, &UBRR0L, &UCSR0A, &UCSR0B, &UCSR0C, &UDR0);
+#endif
+
+// Function that can be weakly referenced by serialEventRun to prevent
+// pulling in this file if it's not otherwise used.
+bool Serial0_available() {
+  return Serial.available();
+}
+
+#endif // HAVE_HWSERIAL0

cores/arduino/HardwareSerial1.cpp

@@ -0,0 +1,69 @@
+/*
+  HardwareSerial1.cpp - Hardware serial library for Wiring
+  Copyright (c) 2006 Nicholas Zambetti.  All right reserved.
+
+  This library is free software; you can redistribute it and/or
+  modify it under the terms of the GNU Lesser General Public
+  License as published by the Free Software Foundation; either
+  version 2.1 of the License, or (at your option) any later version.
+
+  This library 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
+  Lesser General Public License for more details.
+
+  You should have received a copy of the GNU Lesser General Public
+  License along with this library; if not, write to the Free Software
+  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
+
+  Modified 23 November 2006 by David A. Mellis
+  Modified 28 September 2010 by Mark Sproul
+  Modified 14 August 2012 by Alarus
+  Modified 3 December 2013 by Matthijs Kooijman
+*/
+
+#include "Arduino.h"
+#include "HardwareSerial.h"
+#include "HardwareSerial_private.h"
+
+// Each HardwareSerial is defined in its own file, since the linker pulls
+// in the entire file when any element inside is used. --gc-sections can
+// additionally cause unused symbols to be dropped, but ISRs have the
+// "used" attribute so are never dropped and they keep the
+// HardwareSerial instance in as well. Putting each instance in its own
+// file prevents the linker from pulling in any unused instances in the
+// first place.
+
+#if defined(HAVE_HWSERIAL1)
+
+#if defined(UART1_RX_vect)
+ISR(UART1_RX_vect)
+#elif defined(USART1_RX_vect)
+ISR(USART1_RX_vect)
+#else
+#error "Don't know what the Data Register Empty vector is called for Serial1"
+#endif
+{
+  Serial1._rx_complete_irq();
+}
+
+#if defined(UART1_UDRE_vect)
+ISR(UART1_UDRE_vect)
+#elif defined(USART1_UDRE_vect)
+ISR(USART1_UDRE_vect)
+#else
+#error "Don't know what the Data Register Empty vector is called for Serial1"
+#endif
+{
+  Serial1._tx_udr_empty_irq();
+}
+
+HardwareSerial Serial1(&UBRR1H, &UBRR1L, &UCSR1A, &UCSR1B, &UCSR1C, &UDR1);
+
+// Function that can be weakly referenced by serialEventRun to prevent
+// pulling in this file if it's not otherwise used.
+bool Serial1_available() {
+  return Serial1.available();
+}
+
+#endif // HAVE_HWSERIAL1

cores/arduino/HardwareSerial2.cpp

@@ -0,0 +1,57 @@
+/*
+  HardwareSerial2.cpp - Hardware serial library for Wiring
+  Copyright (c) 2006 Nicholas Zambetti.  All right reserved.
+
+  This library is free software; you can redistribute it and/or
+  modify it under the terms of the GNU Lesser General Public
+  License as published by the Free Software Foundation; either
+  version 2.1 of the License, or (at your option) any later version.
+
+  This library 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
+  Lesser General Public License for more details.
+
+  You should have received a copy of the GNU Lesser General Public
+  License along with this library; if not, write to the Free Software
+  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
+
+  Modified 23 November 2006 by David A. Mellis
+  Modified 28 September 2010 by Mark Sproul
+  Modified 14 August 2012 by Alarus
+  Modified 3 December 2013 by Matthijs Kooijman
+*/
+
+#include "Arduino.h"
+#include "HardwareSerial.h"
+#include "HardwareSerial_private.h"
+
+// Each HardwareSerial is defined in its own file, since the linker pulls
+// in the entire file when any element inside is used. --gc-sections can
+// additionally cause unused symbols to be dropped, but ISRs have the
+// "used" attribute so are never dropped and they keep the
+// HardwareSerial instance in as well. Putting each instance in its own
+// file prevents the linker from pulling in any unused instances in the
+// first place.
+
+#if defined(HAVE_HWSERIAL2)
+
+ISR(USART2_RX_vect)
+{
+  Serial2._rx_complete_irq();
+}
+
+ISR(USART2_UDRE_vect)
+{
+  Serial2._tx_udr_empty_irq();
+}
+
+HardwareSerial Serial2(&UBRR2H, &UBRR2L, &UCSR2A, &UCSR2B, &UCSR2C, &UDR2);
+
+// Function that can be weakly referenced by serialEventRun to prevent
+// pulling in this file if it's not otherwise used.
+bool Serial2_available() {
+  return Serial2.available();
+}
+
+#endif // HAVE_HWSERIAL2

cores/arduino/HardwareSerial3.cpp

@@ -0,0 +1,57 @@
+/*
+  HardwareSerial3.cpp - Hardware serial library for Wiring
+  Copyright (c) 2006 Nicholas Zambetti.  All right reserved.
+
+  This library is free software; you can redistribute it and/or
+  modify it under the terms of the GNU Lesser General Public
+  License as published by the Free Software Foundation; either
+  version 2.1 of the License, or (at your option) any later version.
+
+  This library 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
+  Lesser General Public License for more details.
+
+  You should have received a copy of the GNU Lesser General Public
+  License along with this library; if not, write to the Free Software
+  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
+
+  Modified 23 November 2006 by David A. Mellis
+  Modified 28 September 2010 by Mark Sproul
+  Modified 14 August 2012 by Alarus
+  Modified 3 December 2013 by Matthijs Kooijman
+*/
+
+#include "Arduino.h"
+#include "HardwareSerial.h"
+#include "HardwareSerial_private.h"
+
+// Each HardwareSerial is defined in its own file, since the linker pulls
+// in the entire file when any element inside is used. --gc-sections can
+// additionally cause unused symbols to be dropped, but ISRs have the
+// "used" attribute so are never dropped and they keep the
+// HardwareSerial instance in as well. Putting each instance in its own
+// file prevents the linker from pulling in any unused instances in the
+// first place.
+
+#if defined(HAVE_HWSERIAL3)
+
+ISR(USART3_RX_vect)
+{
+  Serial3._rx_complete_irq();
+}
+
+ISR(USART3_UDRE_vect)
+{
+  Serial3._tx_udr_empty_irq();
+}
+
+HardwareSerial Serial3(&UBRR3H, &UBRR3L, &UCSR3A, &UCSR3B, &UCSR3C, &UDR3);
+
+// Function that can be weakly referenced by serialEventRun to prevent
+// pulling in this file if it's not otherwise used.
+bool Serial3_available() {
+  return Serial3.available();
+}
+
+#endif // HAVE_HWSERIAL3

cores/arduino/HardwareSerial_private.h

@@ -0,0 +1,123 @@
+/*
+  HardwareSerial_private.h - Hardware serial library for Wiring
+  Copyright (c) 2006 Nicholas Zambetti.  All right reserved.
+
+  This library is free software; you can redistribute it and/or
+  modify it under the terms of the GNU Lesser General Public
+  License as published by the Free Software Foundation; either
+  version 2.1 of the License, or (at your option) any later version.
+
+  This library 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
+  Lesser General Public License for more details.
+
+  You should have received a copy of the GNU Lesser General Public
+  License along with this library; if not, write to the Free Software
+  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
+
+  Modified 23 November 2006 by David A. Mellis
+  Modified 28 September 2010 by Mark Sproul
+  Modified 14 August 2012 by Alarus
+*/
+
+#include "wiring_private.h"
+
+// this next line disables the entire HardwareSerial.cpp, 
+// this is so I can support Attiny series and any other chip without a uart
+#if defined(HAVE_HWSERIAL0) || defined(HAVE_HWSERIAL1) || defined(HAVE_HWSERIAL2) || defined(HAVE_HWSERIAL3)
+
+// Ensure that the various bit positions we use are available with a 0
+// postfix, so we can always use the values for UART0 for all UARTs. The
+// alternative, passing the various values for each UART to the
+// HardwareSerial constructor also works, but makes the code bigger and
+// slower.
+#if !defined(TXC0)
+#if defined(TXC)
+// Some chips like ATmega8 don't have UPE, only PE. The other bits are
+// named as expected.
+#if !defined(UPE) && defined(PE)
+#define UPE PE
+#endif
+// On ATmega8, the uart and its bits are not numbered, so there is no TXC0 etc.
+#define TXC0 TXC
+#define RXEN0 RXEN
+#define TXEN0 TXEN
+#define RXCIE0 RXCIE
+#define UDRIE0 UDRIE
+#define U2X0 U2X
+#define UPE0 UPE
+#define UDRE0 UDRE
+#elif defined(TXC1)
+// Some devices have uart1 but no uart0
+#define TXC0 TXC1
+#define RXEN0 RXEN1
+#define TXEN0 TXEN1
+#define RXCIE0 RXCIE1
+#define UDRIE0 UDRIE1
+#define U2X0 U2X1
+#define UPE0 UPE1
+#define UDRE0 UDRE1
+#else
+#error No UART found in HardwareSerial.cpp
+#endif
+#endif // !defined TXC0
+
+// Check at compile time that it is really ok to use the bit positions of
+// UART0 for the other UARTs as well, in case these values ever get
+// changed for future hardware.
+#if defined(TXC1) && (TXC1 != TXC0 || RXEN1 != RXEN0 || RXCIE1 != RXCIE0 || \
+		      UDRIE1 != UDRIE0 || U2X1 != U2X0 || UPE1 != UPE0 || \
+		      UDRE1 != UDRE0)
+#error "Not all bit positions for UART1 are the same as for UART0"
+#endif
+#if defined(TXC2) && (TXC2 != TXC0 || RXEN2 != RXEN0 || RXCIE2 != RXCIE0 || \
+		      UDRIE2 != UDRIE0 || U2X2 != U2X0 || UPE2 != UPE0 || \
+		      UDRE2 != UDRE0)
+#error "Not all bit positions for UART2 are the same as for UART0"
+#endif
+#if defined(TXC3) && (TXC3 != TXC0 || RXEN3 != RXEN0 || RXCIE3 != RXCIE0 || \
+		      UDRIE3 != UDRIE0 || U3X3 != U3X0 || UPE3 != UPE0 || \
+		      UDRE3 != UDRE0)
+#error "Not all bit positions for UART3 are the same as for UART0"
+#endif
+
+// Constructors ////////////////////////////////////////////////////////////////
+
+HardwareSerial::HardwareSerial(
+  volatile uint8_t *ubrrh, volatile uint8_t *ubrrl,
+  volatile uint8_t *ucsra, volatile uint8_t *ucsrb,
+  volatile uint8_t *ucsrc, volatile uint8_t *udr) :
+    _ubrrh(ubrrh), _ubrrl(ubrrl),
+    _ucsra(ucsra), _ucsrb(ucsrb), _ucsrc(ucsrc),
+    _udr(udr),
+    _rx_buffer_head(0), _rx_buffer_tail(0),
+    _tx_buffer_head(0), _tx_buffer_tail(0)
+{
+}
+
+// Actual interrupt handlers //////////////////////////////////////////////////////////////
+
+void HardwareSerial::_rx_complete_irq(void)
+{
+  if (bit_is_clear(*_ucsra, UPE0)) {
+    // No Parity error, read byte and store it in the buffer if there is
+    // room
+    unsigned char c = *_udr;
+    rx_buffer_index_t i = (unsigned int)(_rx_buffer_head + 1) % SERIAL_RX_BUFFER_SIZE;
+
+    // if we should be storing the received character into the location
+    // just before the tail (meaning that the head would advance to the
+    // current location of the tail), we're about to overflow the buffer
+    // and so we don't write the character or advance the head.
+    if (i != _rx_buffer_tail) {
+      _rx_buffer[_rx_buffer_head] = c;
+      _rx_buffer_head = i;
+    }
+  } else {
+    // Parity error, read byte but discard it
+    *_udr;
+  };
+}
+
+#endif // whole file

cores/arduino/IPAddress.cpp

@@ -0,0 +1,114 @@
+/*
+  IPAddress.cpp - Base class that provides IPAddress
+  Copyright (c) 2011 Adrian McEwen.  All right reserved.
+
+  This library is free software; you can redistribute it and/or
+  modify it under the terms of the GNU Lesser General Public
+  License as published by the Free Software Foundation; either
+  version 2.1 of the License, or (at your option) any later version.
+
+  This library 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
+  Lesser General Public License for more details.
+
+  You should have received a copy of the GNU Lesser General Public
+  License along with this library; if not, write to the Free Software
+  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
+*/
+
+#include <Arduino.h>
+#include <IPAddress.h>
+
+IPAddress::IPAddress()
+{
+    _address.dword = 0;
+}
+
+IPAddress::IPAddress(uint8_t first_octet, uint8_t second_octet, uint8_t third_octet, uint8_t fourth_octet)
+{
+    _address.bytes[0] = first_octet;
+    _address.bytes[1] = second_octet;
+    _address.bytes[2] = third_octet;
+    _address.bytes[3] = fourth_octet;
+}
+
+IPAddress::IPAddress(uint32_t address)
+{
+    _address.dword = address;
+}
+
+IPAddress::IPAddress(const uint8_t *address)
+{
+    memcpy(_address.bytes, address, sizeof(_address.bytes));
+}
+
+bool IPAddress::fromString(const char *address)
+{
+    uint16_t acc = 0; // Accumulator
+    uint8_t dots = 0;
+
+    while (*address)
+    {
+        char c = *address++;
+        if (c >= '0' && c <= '9')
+        {
+            acc = acc * 10 + (c - '0');
+            if (acc > 255) {
+                // Value out of [0..255] range
+                return false;
+            }
+        }
+        else if (c == '.')
+        {
+            if (dots == 3) {
+                // Too much dots (there must be 3 dots)
+                return false;
+            }
+            _address.bytes[dots++] = acc;
+            acc = 0;
+        }
+        else
+        {
+            // Invalid char
+            return false;
+        }
+    }
+
+    if (dots != 3) {
+        // Too few dots (there must be 3 dots)
+        return false;
+    }
+    _address.bytes[3] = acc;
+    return true;
+}
+
+IPAddress& IPAddress::operator=(const uint8_t *address)
+{
+    memcpy(_address.bytes, address, sizeof(_address.bytes));
+    return *this;
+}
+
+IPAddress& IPAddress::operator=(uint32_t address)
+{
+    _address.dword = address;
+    return *this;
+}
+
+bool IPAddress::operator==(const uint8_t* addr) const
+{
+    return memcmp(addr, _address.bytes, sizeof(_address.bytes)) == 0;
+}
+
+size_t IPAddress::printTo(Print& p) const
+{
+    size_t n = 0;
+    for (int i =0; i < 3; i++)
+    {
+        n += p.print(_address.bytes[i], DEC);
+        n += p.print('.');
+    }
+    n += p.print(_address.bytes[3], DEC);
+    return n;
+}
+

cores/arduino/IPAddress.h

@@ -0,0 +1,78 @@
+/*
+  IPAddress.h - Base class that provides IPAddress
+  Copyright (c) 2011 Adrian McEwen.  All right reserved.
+
+  This library is free software; you can redistribute it and/or
+  modify it under the terms of the GNU Lesser General Public
+  License as published by the Free Software Foundation; either
+  version 2.1 of the License, or (at your option) any later version.
+
+  This library 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
+  Lesser General Public License for more details.
+
+  You should have received a copy of the GNU Lesser General Public
+  License along with this library; if not, write to the Free Software
+  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
+*/
+
+#ifndef IPAddress_h
+#define IPAddress_h
+
+#include <stdint.h>
+#include "Printable.h"
+#include "WString.h"
+
+// A class to make it easier to handle and pass around IP addresses
+
+class IPAddress : public Printable {
+private:
+    union {
+	uint8_t bytes[4];  // IPv4 address
+	uint32_t dword;
+    } _address;
+
+    // Access the raw byte array containing the address.  Because this returns a pointer
+    // to the internal structure rather than a copy of the address this function should only
+    // be used when you know that the usage of the returned uint8_t* will be transient and not
+    // stored.
+    uint8_t* raw_address() { return _address.bytes; };
+
+public:
+    // Constructors
+    IPAddress();
+    IPAddress(uint8_t first_octet, uint8_t second_octet, uint8_t third_octet, uint8_t fourth_octet);
+    IPAddress(uint32_t address);
+    IPAddress(const uint8_t *address);
+
+    bool fromString(const char *address);
+    bool fromString(const String &address) { return fromString(address.c_str()); }
+
+    // Overloaded cast operator to allow IPAddress objects to be used where a pointer
+    // to a four-byte uint8_t array is expected
+    operator uint32_t() const { return _address.dword; };
+    bool operator==(const IPAddress& addr) const { return _address.dword == addr._address.dword; };
+    bool operator==(const uint8_t* addr) const;
+
+    // Overloaded index operator to allow getting and setting individual octets of the address
+    uint8_t operator[](int index) const { return _address.bytes[index]; };
+    uint8_t& operator[](int index) { return _address.bytes[index]; };
+
+    // Overloaded copy operators to allow initialisation of IPAddress objects from other types
+    IPAddress& operator=(const uint8_t *address);
+    IPAddress& operator=(uint32_t address);
+
+    virtual size_t printTo(Print& p) const;
+
+    friend class EthernetClass;
+    friend class UDP;
+    friend class Client;
+    friend class Server;
+    friend class DhcpClass;
+    friend class DNSClient;
+};
+
+const IPAddress INADDR_NONE(0,0,0,0);
+
+#endif

cores/arduino/PluggableUSB.cpp

@@ -0,0 +1,115 @@
+/*
+  PluggableUSB.cpp
+  Copyright (c) 2015 Arduino LLC
+
+  This library is free software; you can redistribute it and/or
+  modify it under the terms of the GNU Lesser General Public
+  License as published by the Free Software Foundation; either
+  version 2.1 of the License, or (at your option) any later version.
+
+  This library 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
+  Lesser General Public License for more details.
+
+  You should have received a copy of the GNU Lesser General Public
+  License along with this library; if not, write to the Free Software
+  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
+*/
+
+#include "USBAPI.h"
+#include "PluggableUSB.h"
+
+#if defined(USBCON)	
+#ifdef PLUGGABLE_USB_ENABLED
+
+extern uint8_t _initEndpoints[];
+
+int PluggableUSB_::getInterface(uint8_t* interfaceCount)
+{
+	int sent = 0;
+	PluggableUSBModule* node;
+	for (node = rootNode; node; node = node->next) {
+		int res = node->getInterface(interfaceCount);
+		if (res < 0)
+			return -1;
+		sent += res;
+	}
+	return sent;
+}
+
+int PluggableUSB_::getDescriptor(USBSetup& setup)
+{
+	PluggableUSBModule* node;
+	for (node = rootNode; node; node = node->next) {
+		int ret = node->getDescriptor(setup);
+		// ret!=0 -> request has been processed
+		if (ret)
+			return ret;
+	}
+	return 0;
+}
+
+void PluggableUSB_::getShortName(char *iSerialNum)
+{
+	PluggableUSBModule* node;
+	for (node = rootNode; node; node = node->next) {
+		iSerialNum += node->getShortName(iSerialNum);
+	}
+	*iSerialNum = 0;
+}
+
+bool PluggableUSB_::setup(USBSetup& setup)
+{
+	PluggableUSBModule* node;
+	for (node = rootNode; node; node = node->next) {
+		if (node->setup(setup)) {
+			return true;
+		}
+	}
+	return false;
+}
+
+bool PluggableUSB_::plug(PluggableUSBModule *node)
+{
+	if ((lastEp + node->numEndpoints) > USB_ENDPOINTS) {
+		return false;
+	}
+
+	if (!rootNode) {
+		rootNode = node;
+	} else {
+		PluggableUSBModule *current = rootNode;
+		while (current->next) {
+			current = current->next;
+		}
+		current->next = node;
+	}
+
+	node->pluggedInterface = lastIf;
+	node->pluggedEndpoint = lastEp;
+	lastIf += node->numInterfaces;
+	for (uint8_t i = 0; i < node->numEndpoints; i++) {
+		_initEndpoints[lastEp] = node->endpointType[i];
+		lastEp++;
+	}
+	return true;
+	// restart USB layer???
+}
+
+PluggableUSB_& PluggableUSB()
+{
+	static PluggableUSB_ obj;
+	return obj;
+}
+
+PluggableUSB_::PluggableUSB_() : lastIf(CDC_ACM_INTERFACE + CDC_INTERFACE_COUNT),
+                                 lastEp(CDC_FIRST_ENDPOINT + CDC_ENPOINT_COUNT),
+                                 rootNode(NULL)
+{
+	// Empty
+}
+
+#endif
+
+#endif /* if defined(USBCON) */

cores/arduino/PluggableUSB.h

@@ -0,0 +1,74 @@
+/*
+  PluggableUSB.h
+  Copyright (c) 2015 Arduino LLC
+
+  This library is free software; you can redistribute it and/or
+  modify it under the terms of the GNU Lesser General Public
+  License as published by the Free Software Foundation; either
+  version 2.1 of the License, or (at your option) any later version.
+
+  This library 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
+  Lesser General Public License for more details.
+
+  You should have received a copy of the GNU Lesser General Public
+  License along with this library; if not, write to the Free Software
+  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
+*/
+
+#ifndef PUSB_h
+#define PUSB_h
+
+#include "USBAPI.h"
+#include <stdint.h>
+
+#if defined(USBCON)
+
+class PluggableUSBModule {
+public:
+  PluggableUSBModule(uint8_t numEps, uint8_t numIfs, uint8_t *epType) :
+    numEndpoints(numEps), numInterfaces(numIfs), endpointType(epType)
+  { }
+
+protected:
+  virtual bool setup(USBSetup& setup) = 0;
+  virtual int getInterface(uint8_t* interfaceCount) = 0;
+  virtual int getDescriptor(USBSetup& setup) = 0;
+  virtual uint8_t getShortName(char *name) { name[0] = 'A'+pluggedInterface; return 1; }
+
+  uint8_t pluggedInterface;
+  uint8_t pluggedEndpoint;
+
+  const uint8_t numEndpoints;
+  const uint8_t numInterfaces;
+  const uint8_t *endpointType;
+
+  PluggableUSBModule *next = NULL;
+
+  friend class PluggableUSB_;
+};
+
+class PluggableUSB_ {
+public:
+  PluggableUSB_();
+  bool plug(PluggableUSBModule *node);
+  int getInterface(uint8_t* interfaceCount);
+  int getDescriptor(USBSetup& setup);
+  bool setup(USBSetup& setup);
+  void getShortName(char *iSerialNum);
+
+private:
+  uint8_t lastIf;
+  uint8_t lastEp;
+  PluggableUSBModule* rootNode;
+};
+
+// Replacement for global singleton.
+// This function prevents static-initialization-order-fiasco
+// https://isocpp.org/wiki/faq/ctors#static-init-order-on-first-use
+PluggableUSB_& PluggableUSB();
+
+#endif
+
+#endif

cores/arduino/Print.cpp

@@ -0,0 +1,266 @@
+/*
+ Print.cpp - Base class that provides print() and println()
+ Copyright (c) 2008 David A. Mellis.  All right reserved.
+ 
+ This library is free software; you can redistribute it and/or
+ modify it under the terms of the GNU Lesser General Public
+ License as published by the Free Software Foundation; either
+ version 2.1 of the License, or (at your option) any later version.
+ 
+ This library 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
+ Lesser General Public License for more details.
+ 
+ You should have received a copy of the GNU Lesser General Public
+ License along with this library; if not, write to the Free Software
+ Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
+ 
+ Modified 23 November 2006 by David A. Mellis
+ Modified 03 August 2015 by Chuck Todd
+ */
+
+#include <stdlib.h>
+#include <stdio.h>
+#include <string.h>
+#include <math.h>
+#include "Arduino.h"
+
+#include "Print.h"
+
+// Public Methods //////////////////////////////////////////////////////////////
+
+/* default implementation: may be overridden */
+size_t Print::write(const uint8_t *buffer, size_t size)
+{
+  size_t n = 0;
+  while (size--) {
+    if (write(*buffer++)) n++;
+    else break;
+  }
+  return n;
+}
+
+size_t Print::print(const __FlashStringHelper *ifsh)
+{
+  PGM_P p = reinterpret_cast<PGM_P>(ifsh);
+  size_t n = 0;
+  while (1) {
+    unsigned char c = pgm_read_byte(p++);
+    if (c == 0) break;
+    if (write(c)) n++;
+    else break;
+  }
+  return n;
+}
+
+size_t Print::print(const String &s)
+{
+  return write(s.c_str(), s.length());
+}
+
+size_t Print::print(const char str[])
+{
+  return write(str);
+}
+
+size_t Print::print(char c)
+{
+  return write(c);
+}
+
+size_t Print::print(unsigned char b, int base)
+{
+  return print((unsigned long) b, base);
+}
+
+size_t Print::print(int n, int base)
+{
+  return print((long) n, base);
+}
+
+size_t Print::print(unsigned int n, int base)
+{
+  return print((unsigned long) n, base);
+}
+
+size_t Print::print(long n, int base)
+{
+  if (base == 0) {
+    return write(n);
+  } else if (base == 10) {
+    if (n < 0) {
+      int t = print('-');
+      n = -n;
+      return printNumber(n, 10) + t;
+    }
+    return printNumber(n, 10);
+  } else {
+    return printNumber(n, base);
+  }
+}
+
+size_t Print::print(unsigned long n, int base)
+{
+  if (base == 0) return write(n);
+  else return printNumber(n, base);
+}
+
+size_t Print::print(double n, int digits)
+{
+  return printFloat(n, digits);
+}
+
+size_t Print::println(const __FlashStringHelper *ifsh)
+{
+  size_t n = print(ifsh);
+  n += println();
+  return n;
+}
+
+size_t Print::print(const Printable& x)
+{
+  return x.printTo(*this);
+}
+
+size_t Print::println(void)
+{
+  return write("\r\n");
+}
+
+size_t Print::println(const String &s)
+{
+  size_t n = print(s);
+  n += println();
+  return n;
+}
+
+size_t Print::println(const char c[])
+{
+  size_t n = print(c);
+  n += println();
+  return n;
+}
+
+size_t Print::println(char c)
+{
+  size_t n = print(c);
+  n += println();
+  return n;
+}
+
+size_t Print::println(unsigned char b, int base)
+{
+  size_t n = print(b, base);
+  n += println();
+  return n;
+}
+
+size_t Print::println(int num, int base)
+{
+  size_t n = print(num, base);
+  n += println();
+  return n;
+}
+
+size_t Print::println(unsigned int num, int base)
+{
+  size_t n = print(num, base);
+  n += println();
+  return n;
+}
+
+size_t Print::println(long num, int base)
+{
+  size_t n = print(num, base);
+  n += println();
+  return n;
+}
+
+size_t Print::println(unsigned long num, int base)
+{
+  size_t n = print(num, base);
+  n += println();
+  return n;
+}
+
+size_t Print::println(double num, int digits)
+{
+  size_t n = print(num, digits);
+  n += println();
+  return n;
+}
+
+size_t Print::println(const Printable& x)
+{
+  size_t n = print(x);
+  n += println();
+  return n;
+}
+
+// Private Methods /////////////////////////////////////////////////////////////
+
+size_t Print::printNumber(unsigned long n, uint8_t base)
+{
+  char buf[8 * sizeof(long) + 1]; // Assumes 8-bit chars plus zero byte.
+  char *str = &buf[sizeof(buf) - 1];
+
+  *str = '\0';
+
+  // prevent crash if called with base == 1
+  if (base < 2) base = 10;
+
+  do {
+    char c = n % base;
+    n /= base;
+
+    *--str = c < 10 ? c + '0' : c + 'A' - 10;
+  } while(n);
+
+  return write(str);
+}
+
+size_t Print::printFloat(double number, uint8_t digits) 
+{ 
+  size_t n = 0;
+  
+  if (isnan(number)) return print("nan");
+  if (isinf(number)) return print("inf");
+  if (number > 4294967040.0) return print ("ovf");  // constant determined empirically
+  if (number <-4294967040.0) return print ("ovf");  // constant determined empirically
+  
+  // Handle negative numbers
+  if (number < 0.0)
+  {
+     n += print('-');
+     number = -number;
+  }
+
+  // Round correctly so that print(1.999, 2) prints as "2.00"
+  double rounding = 0.5;
+  for (uint8_t i=0; i<digits; ++i)
+    rounding /= 10.0;
+  
+  number += rounding;
+
+  // Extract the integer part of the number and print it
+  unsigned long int_part = (unsigned long)number;
+  double remainder = number - (double)int_part;
+  n += print(int_part);
+
+  // Print the decimal point, but only if there are digits beyond
+  if (digits > 0) {
+    n += print('.'); 
+  }
+
+  // Extract digits from the remainder one at a time
+  while (digits-- > 0)
+  {
+    remainder *= 10.0;
+    unsigned int toPrint = (unsigned int)(remainder);
+    n += print(toPrint);
+    remainder -= toPrint; 
+  } 
+  
+  return n;
+}

cores/arduino/Print.h

@@ -0,0 +1,93 @@
+/*
+  Print.h - Base class that provides print() and println()
+  Copyright (c) 2008 David A. Mellis.  All right reserved.
+
+  This library is free software; you can redistribute it and/or
+  modify it under the terms of the GNU Lesser General Public
+  License as published by the Free Software Foundation; either
+  version 2.1 of the License, or (at your option) any later version.
+
+  This library 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
+  Lesser General Public License for more details.
+
+  You should have received a copy of the GNU Lesser General Public
+  License along with this library; if not, write to the Free Software
+  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
+*/
+
+#ifndef Print_h
+#define Print_h
+
+#include <inttypes.h>
+#include <stdio.h> // for size_t
+
+#include "WString.h"
+#include "Printable.h"
+
+#define DEC 10
+#define HEX 16
+#define OCT 8
+#ifdef BIN // Prevent warnings if BIN is previously defined in "iotnx4.h" or similar
+#undef BIN
+#endif
+#define BIN 2
+
+class Print
+{
+  private:
+    int write_error;
+    size_t printNumber(unsigned long, uint8_t);
+    size_t printFloat(double, uint8_t);
+  protected:
+    void setWriteError(int err = 1) { write_error = err; }
+  public:
+    Print() : write_error(0) {}
+  
+    int getWriteError() { return write_error; }
+    void clearWriteError() { setWriteError(0); }
+  
+    virtual size_t write(uint8_t) = 0;
+    size_t write(const char *str) {
+      if (str == NULL) return 0;
+      return write((const uint8_t *)str, strlen(str));
+    }
+    virtual size_t write(const uint8_t *buffer, size_t size);
+    size_t write(const char *buffer, size_t size) {
+      return write((const uint8_t *)buffer, size);
+    }
+
+    // default to zero, meaning "a single write may block"
+    // should be overridden by subclasses with buffering
+    virtual int availableForWrite() { return 0; }
+
+    size_t print(const __FlashStringHelper *);
+    size_t print(const String &);
+    size_t print(const char[]);
+    size_t print(char);
+    size_t print(unsigned char, int = DEC);
+    size_t print(int, int = DEC);
+    size_t print(unsigned int, int = DEC);
+    size_t print(long, int = DEC);
+    size_t print(unsigned long, int = DEC);
+    size_t print(double, int = 2);
+    size_t print(const Printable&);
+
+    size_t println(const __FlashStringHelper *);
+    size_t println(const String &s);
+    size_t println(const char[]);
+    size_t println(char);
+    size_t println(unsigned char, int = DEC);
+    size_t println(int, int = DEC);
+    size_t println(unsigned int, int = DEC);
+    size_t println(long, int = DEC);
+    size_t println(unsigned long, int = DEC);
+    size_t println(double, int = 2);
+    size_t println(const Printable&);
+    size_t println(void);
+
+    virtual void flush() { /* Empty implementation for backward compatibility */ }
+};
+
+#endif

cores/arduino/Printable.h

@@ -0,0 +1,40 @@
+/*
+  Printable.h - Interface class that allows printing of complex types
+  Copyright (c) 2011 Adrian McEwen.  All right reserved.
+
+  This library is free software; you can redistribute it and/or
+  modify it under the terms of the GNU Lesser General Public
+  License as published by the Free Software Foundation; either
+  version 2.1 of the License, or (at your option) any later version.
+
+  This library 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
+  Lesser General Public License for more details.
+
+  You should have received a copy of the GNU Lesser General Public
+  License along with this library; if not, write to the Free Software
+  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
+*/
+
+#ifndef Printable_h
+#define Printable_h
+
+#include <stdlib.h>
+
+class Print;
+
+/** The Printable class provides a way for new classes to allow themselves to be printed.
+    By deriving from Printable and implementing the printTo method, it will then be possible
+    for users to print out instances of this class by passing them into the usual
+    Print::print and Print::println methods.
+*/
+
+class Printable
+{
+  public:
+    virtual size_t printTo(Print& p) const = 0;
+};
+
+#endif
+

cores/arduino/Server.h

@@ -0,0 +1,30 @@
+/*
+  Server.h - Base class that provides Server
+  Copyright (c) 2011 Adrian McEwen.  All right reserved.
+
+  This library is free software; you can redistribute it and/or
+  modify it under the terms of the GNU Lesser General Public
+  License as published by the Free Software Foundation; either
+  version 2.1 of the License, or (at your option) any later version.
+
+  This library 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
+  Lesser General Public License for more details.
+
+  You should have received a copy of the GNU Lesser General Public
+  License along with this library; if not, write to the Free Software
+  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
+*/
+
+#ifndef server_h
+#define server_h
+
+#include "Print.h"
+
+class Server : public Print {
+public:
+  virtual void begin() =0;
+};
+
+#endif

cores/arduino/Stream.cpp

@@ -0,0 +1,318 @@
+/*
+ Stream.cpp - adds parsing methods to Stream class
+ Copyright (c) 2008 David A. Mellis.  All right reserved.
+
+ This library is free software; you can redistribute it and/or
+ modify it under the terms of the GNU Lesser General Public
+ License as published by the Free Software Foundation; either
+ version 2.1 of the License, or (at your option) any later version.
+
+ This library 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
+ Lesser General Public License for more details.
+
+ You should have received a copy of the GNU Lesser General Public
+ License along with this library; if not, write to the Free Software
+ Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
+
+ Created July 2011
+ parsing functions based on TextFinder library by Michael Margolis
+
+ findMulti/findUntil routines written by Jim Leonard/Xuth
+ */
+
+#include "Arduino.h"
+#include "Stream.h"
+
+#define PARSE_TIMEOUT 1000  // default number of milli-seconds to wait
+
+// protected method to read stream with timeout
+int Stream::timedRead()
+{
+  int c;
+  _startMillis = millis();
+  do {
+    c = read();
+    if (c >= 0) return c;
+  } while(millis() - _startMillis < _timeout);
+  return -1;     // -1 indicates timeout
+}
+
+// protected method to peek stream with timeout
+int Stream::timedPeek()
+{
+  int c;
+  _startMillis = millis();
+  do {
+    c = peek();
+    if (c >= 0) return c;
+  } while(millis() - _startMillis < _timeout);
+  return -1;     // -1 indicates timeout
+}
+
+// returns peek of the next digit in the stream or -1 if timeout
+// discards non-numeric characters
+int Stream::peekNextDigit(LookaheadMode lookahead, bool detectDecimal)
+{
+  int c;
+  while (1) {
+    c = timedPeek();
+
+    if( c < 0 ||
+        c == '-' ||
+        (c >= '0' && c <= '9') ||
+        (detectDecimal && c == '.')) return c;
+
+    switch( lookahead ){
+        case SKIP_NONE: return -1; // Fail code.
+        case SKIP_WHITESPACE:
+            switch( c ){
+                case ' ':
+                case '\t':
+                case '\r':
+                case '\n': break;
+                default: return -1; // Fail code.
+            }
+        case SKIP_ALL:
+            break;
+    }
+    read();  // discard non-numeric
+  }
+}
+
+// Public Methods
+//////////////////////////////////////////////////////////////
+
+void Stream::setTimeout(unsigned long timeout)  // sets the maximum number of milliseconds to wait
+{
+  _timeout = timeout;
+}
+
+ // find returns true if the target string is found
+bool  Stream::find(char *target)
+{
+  return findUntil(target, strlen(target), NULL, 0);
+}
+
+// reads data from the stream until the target string of given length is found
+// returns true if target string is found, false if timed out
+bool Stream::find(char *target, size_t length)
+{
+  return findUntil(target, length, NULL, 0);
+}
+
+// as find but search ends if the terminator string is found
+bool  Stream::findUntil(char *target, char *terminator)
+{
+  return findUntil(target, strlen(target), terminator, strlen(terminator));
+}
+
+// reads data from the stream until the target string of the given length is found
+// search terminated if the terminator string is found
+// returns true if target string is found, false if terminated or timed out
+bool Stream::findUntil(char *target, size_t targetLen, char *terminator, size_t termLen)
+{
+  if (terminator == NULL) {
+    MultiTarget t[1] = {{target, targetLen, 0}};
+    return findMulti(t, 1) == 0 ? true : false;
+  } else {
+    MultiTarget t[2] = {{target, targetLen, 0}, {terminator, termLen, 0}};
+    return findMulti(t, 2) == 0 ? true : false;
+  }
+}
+
+// returns the first valid (long) integer value from the current position.
+// lookahead determines how parseInt looks ahead in the stream.
+// See LookaheadMode enumeration at the top of the file.
+// Lookahead is terminated by the first character that is not a valid part of an integer.
+// Once parsing commences, 'ignore' will be skipped in the stream.
+long Stream::parseInt(LookaheadMode lookahead, char ignore)
+{
+  bool isNegative = false;
+  long value = 0;
+  int c;
+
+  c = peekNextDigit(lookahead, false);
+  // ignore non numeric leading characters
+  if(c < 0)
+    return 0; // zero returned if timeout
+
+  do{
+    if(c == ignore)
+      ; // ignore this character
+    else if(c == '-')
+      isNegative = true;
+    else if(c >= '0' && c <= '9')        // is c a digit?
+      value = value * 10 + c - '0';
+    read();  // consume the character we got with peek
+    c = timedPeek();
+  }
+  while( (c >= '0' && c <= '9') || c == ignore );
+
+  if(isNegative)
+    value = -value;
+  return value;
+}
+
+// as parseInt but returns a floating point value
+float Stream::parseFloat(LookaheadMode lookahead, char ignore)
+{
+  bool isNegative = false;
+  bool isFraction = false;
+  long value = 0;
+  int c;
+  float fraction = 1.0;
+
+  c = peekNextDigit(lookahead, true);
+    // ignore non numeric leading characters
+  if(c < 0)
+    return 0; // zero returned if timeout
+
+  do{
+    if(c == ignore)
+      ; // ignore
+    else if(c == '-')
+      isNegative = true;
+    else if (c == '.')
+      isFraction = true;
+    else if(c >= '0' && c <= '9')  {      // is c a digit?
+      value = value * 10 + c - '0';
+      if(isFraction)
+         fraction *= 0.1;
+    }
+    read();  // consume the character we got with peek
+    c = timedPeek();
+  }
+  while( (c >= '0' && c <= '9')  || (c == '.' && !isFraction) || c == ignore );
+
+  if(isNegative)
+    value = -value;
+  if(isFraction)
+    return value * fraction;
+  else
+    return value;
+}
+
+// read characters from stream into buffer
+// terminates if length characters have been read, or timeout (see setTimeout)
+// returns the number of characters placed in the buffer
+// the buffer is NOT null terminated.
+//
+size_t Stream::readBytes(char *buffer, size_t length)
+{
+  size_t count = 0;
+  while (count < length) {
+    int c = timedRead();
+    if (c < 0) break;
+    *buffer++ = (char)c;
+    count++;
+  }
+  return count;
+}
+
+
+// as readBytes with terminator character
+// terminates if length characters have been read, timeout, or if the terminator character  detected
+// returns the number of characters placed in the buffer (0 means no valid data found)
+
+size_t Stream::readBytesUntil(char terminator, char *buffer, size_t length)
+{
+  size_t index = 0;
+  while (index < length) {
+    int c = timedRead();
+    if (c < 0 || c == terminator) break;
+    *buffer++ = (char)c;
+    index++;
+  }
+  return index; // return number of characters, not including null terminator
+}
+
+String Stream::readString()
+{
+  String ret;
+  int c = timedRead();
+  while (c >= 0)
+  {
+    ret += (char)c;
+    c = timedRead();
+  }
+  return ret;
+}
+
+String Stream::readStringUntil(char terminator)
+{
+  String ret;
+  int c = timedRead();
+  while (c >= 0 && c != terminator)
+  {
+    ret += (char)c;
+    c = timedRead();
+  }
+  return ret;
+}
+
+int Stream::findMulti( struct Stream::MultiTarget *targets, int tCount) {
+  // any zero length target string automatically matches and would make
+  // a mess of the rest of the algorithm.
+  for (struct MultiTarget *t = targets; t < targets+tCount; ++t) {
+    if (t->len <= 0)
+      return t - targets;
+  }
+
+  while (1) {
+    int c = timedRead();
+    if (c < 0)
+      return -1;
+
+    for (struct MultiTarget *t = targets; t < targets+tCount; ++t) {
+      // the simple case is if we match, deal with that first.
+      if (c == t->str[t->index]) {
+        if (++t->index == t->len)
+          return t - targets;
+        else
+          continue;
+      }
+
+      // if not we need to walk back and see if we could have matched further
+      // down the stream (ie '1112' doesn't match the first position in '11112'
+      // but it will match the second position so we can't just reset the current
+      // index to 0 when we find a mismatch.
+      if (t->index == 0)
+        continue;
+
+      int origIndex = t->index;
+      do {
+        --t->index;
+        // first check if current char works against the new current index
+        if (c != t->str[t->index])
+          continue;
+
+        // if it's the only char then we're good, nothing more to check
+        if (t->index == 0) {
+          t->index++;
+          break;
+        }
+
+        // otherwise we need to check the rest of the found string
+        int diff = origIndex - t->index;
+        size_t i;
+        for (i = 0; i < t->index; ++i) {
+          if (t->str[i] != t->str[i + diff])
+            break;
+        }
+
+        // if we successfully got through the previous loop then our current
+        // index is good.
+        if (i == t->index) {
+          t->index++;
+          break;
+        }
+
+        // otherwise we just try the next index
+      } while (t->index);
+    }
+  }
+  // unreachable
+  return -1;
+}

cores/arduino/Stream.h

@@ -0,0 +1,129 @@
+/*
+  Stream.h - base class for character-based streams.
+  Copyright (c) 2010 David A. Mellis.  All right reserved.
+
+  This library is free software; you can redistribute it and/or
+  modify it under the terms of the GNU Lesser General Public
+  License as published by the Free Software Foundation; either
+  version 2.1 of the License, or (at your option) any later version.
+
+  This library 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
+  Lesser General Public License for more details.
+
+  You should have received a copy of the GNU Lesser General Public
+  License along with this library; if not, write to the Free Software
+  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
+
+  parsing functions based on TextFinder library by Michael Margolis
+*/
+
+#ifndef Stream_h
+#define Stream_h
+
+#include <inttypes.h>
+#include "Print.h"
+
+// compatibility macros for testing
+/*
+#define   getInt()            parseInt()
+#define   getInt(ignore)    parseInt(ignore)
+#define   getFloat()          parseFloat()
+#define   getFloat(ignore)  parseFloat(ignore)
+#define   getString( pre_string, post_string, buffer, length)
+readBytesBetween( pre_string, terminator, buffer, length)
+*/
+
+// This enumeration provides the lookahead options for parseInt(), parseFloat()
+// The rules set out here are used until either the first valid character is found
+// or a time out occurs due to lack of input.
+enum LookaheadMode{
+    SKIP_ALL,       // All invalid characters are ignored.
+    SKIP_NONE,      // Nothing is skipped, and the stream is not touched unless the first waiting character is valid.
+    SKIP_WHITESPACE // Only tabs, spaces, line feeds & carriage returns are skipped.
+};
+
+#define NO_IGNORE_CHAR  '\x01' // a char not found in a valid ASCII numeric field
+
+class Stream : public Print
+{
+  protected:
+    unsigned long _timeout;      // number of milliseconds to wait for the next char before aborting timed read
+    unsigned long _startMillis;  // used for timeout measurement
+    int timedRead();    // read stream with timeout
+    int timedPeek();    // peek stream with timeout
+    int peekNextDigit(LookaheadMode lookahead, bool detectDecimal); // returns the next numeric digit in the stream or -1 if timeout
+
+  public:
+    virtual int available() = 0;
+    virtual int read() = 0;
+    virtual int peek() = 0;
+
+    Stream() {_timeout=1000;}
+
+// parsing methods
+
+  void setTimeout(unsigned long timeout);  // sets maximum milliseconds to wait for stream data, default is 1 second
+  unsigned long getTimeout(void) { return _timeout; }
+  
+  bool find(char *target);   // reads data from the stream until the target string is found
+  bool find(uint8_t *target) { return find ((char *)target); }
+  // returns true if target string is found, false if timed out (see setTimeout)
+
+  bool find(char *target, size_t length);   // reads data from the stream until the target string of given length is found
+  bool find(uint8_t *target, size_t length) { return find ((char *)target, length); }
+  // returns true if target string is found, false if timed out
+
+  bool find(char target) { return find (&target, 1); }
+
+  bool findUntil(char *target, char *terminator);   // as find but search ends if the terminator string is found
+  bool findUntil(uint8_t *target, char *terminator) { return findUntil((char *)target, terminator); }
+
+  bool findUntil(char *target, size_t targetLen, char *terminate, size_t termLen);   // as above but search ends if the terminate string is found
+  bool findUntil(uint8_t *target, size_t targetLen, char *terminate, size_t termLen) {return findUntil((char *)target, targetLen, terminate, termLen); }
+
+  long parseInt(LookaheadMode lookahead = SKIP_ALL, char ignore = NO_IGNORE_CHAR);
+  // returns the first valid (long) integer value from the current position.
+  // lookahead determines how parseInt looks ahead in the stream.
+  // See LookaheadMode enumeration at the top of the file.
+  // Lookahead is terminated by the first character that is not a valid part of an integer.
+  // Once parsing commences, 'ignore' will be skipped in the stream.
+
+  float parseFloat(LookaheadMode lookahead = SKIP_ALL, char ignore = NO_IGNORE_CHAR);
+  // float version of parseInt
+
+  size_t readBytes( char *buffer, size_t length); // read chars from stream into buffer
+  size_t readBytes( uint8_t *buffer, size_t length) { return readBytes((char *)buffer, length); }
+  // terminates if length characters have been read or timeout (see setTimeout)
+  // returns the number of characters placed in the buffer (0 means no valid data found)
+
+  size_t readBytesUntil( char terminator, char *buffer, size_t length); // as readBytes with terminator character
+  size_t readBytesUntil( char terminator, uint8_t *buffer, size_t length) { return readBytesUntil(terminator, (char *)buffer, length); }
+  // terminates if length characters have been read, timeout, or if the terminator character  detected
+  // returns the number of characters placed in the buffer (0 means no valid data found)
+
+  // Arduino String functions to be added here
+  String readString();
+  String readStringUntil(char terminator);
+
+  protected:
+  long parseInt(char ignore) { return parseInt(SKIP_ALL, ignore); }
+  float parseFloat(char ignore) { return parseFloat(SKIP_ALL, ignore); }
+  // These overload exists for compatibility with any class that has derived
+  // Stream and used parseFloat/Int with a custom ignore character. To keep
+  // the public API simple, these overload remains protected.
+
+  struct MultiTarget {
+    const char *str;  // string you're searching for
+    size_t len;       // length of string you're searching for
+    size_t index;     // index used by the search routine.
+  };
+
+  // This allows you to search for an arbitrary number of strings.
+  // Returns index of the target that is found first or -1 if timeout occurs.
+  int findMulti(struct MultiTarget *targets, int tCount);
+};
+
+#undef NO_IGNORE_CHAR
+#endif

cores/arduino/Tone.cpp

@@ -0,0 +1,619 @@
+/* Tone.cpp
+
+  A Tone Generator Library
+
+  Written by Brett Hagman
+
+  This library is free software; you can redistribute it and/or
+  modify it under the terms of the GNU Lesser General Public
+  License as published by the Free Software Foundation; either
+  version 2.1 of the License, or (at your option) any later version.
+
+  This library 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
+  Lesser General Public License for more details.
+
+  You should have received a copy of the GNU Lesser General Public
+  License along with this library; if not, write to the Free Software
+  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
+
+Version Modified By Date     Comments
+------- ----------- -------- --------
+0001    B Hagman    09/08/02 Initial coding
+0002    B Hagman    09/08/18 Multiple pins
+0003    B Hagman    09/08/18 Moved initialization from constructor to begin()
+0004    B Hagman    09/09/26 Fixed problems with ATmega8
+0005    B Hagman    09/11/23 Scanned prescalars for best fit on 8 bit timers
+                    09/11/25 Changed pin toggle method to XOR
+                    09/11/25 Fixed timer0 from being excluded
+0006    D Mellis    09/12/29 Replaced objects with functions
+0007    M Sproul    10/08/29 Changed #ifdefs from cpu to register
+0008    S Kanemoto  12/06/22 Fixed for Leonardo by @maris_HY
+0009    J Reucker   15/04/10 Issue #292 Fixed problems with ATmega8 (thanks to Pete62)
+0010    jipp        15/04/13 added additional define check #2923
+*************************************************/
+
+#include <avr/interrupt.h>
+#include <avr/pgmspace.h>
+#include "Arduino.h"
+#include "pins_arduino.h"
+
+#if defined(__AVR_ATmega8__) || defined(__AVR_ATmega128__)
+#define TCCR2A TCCR2
+#define TCCR2B TCCR2
+#define COM2A1 COM21
+#define COM2A0 COM20
+#define OCR2A OCR2
+#define TIMSK2 TIMSK
+#define OCIE2A OCIE2
+#define TIMER2_COMPA_vect TIMER2_COMP_vect
+#define TIMSK1 TIMSK
+#endif
+
+// timerx_toggle_count:
+//  > 0 - duration specified
+//  = 0 - stopped
+//  < 0 - infinitely (until stop() method called, or new play() called)
+
+#if !defined(__AVR_ATmega8__)
+volatile long timer0_toggle_count;
+volatile uint8_t *timer0_pin_port;
+volatile uint8_t timer0_pin_mask;
+#endif
+
+volatile long timer1_toggle_count;
+volatile uint8_t *timer1_pin_port;
+volatile uint8_t timer1_pin_mask;
+volatile long timer2_toggle_count;
+volatile uint8_t *timer2_pin_port;
+volatile uint8_t timer2_pin_mask;
+
+#if defined(TIMSK3)
+volatile long timer3_toggle_count;
+volatile uint8_t *timer3_pin_port;
+volatile uint8_t timer3_pin_mask;
+#endif
+
+#if defined(TIMSK4)
+volatile long timer4_toggle_count;
+volatile uint8_t *timer4_pin_port;
+volatile uint8_t timer4_pin_mask;
+#endif
+
+#if defined(TIMSK5)
+volatile long timer5_toggle_count;
+volatile uint8_t *timer5_pin_port;
+volatile uint8_t timer5_pin_mask;
+#endif
+
+
+#if defined(__AVR_ATmega1280__) || defined(__AVR_ATmega2560__)
+
+#define AVAILABLE_TONE_PINS 1
+#define USE_TIMER2
+
+const uint8_t PROGMEM tone_pin_to_timer_PGM[] = { 2 /*, 3, 4, 5, 1, 0 */ };
+static uint8_t tone_pins[AVAILABLE_TONE_PINS] = { 255 /*, 255, 255, 255, 255, 255 */ };
+
+#elif defined(__AVR_ATmega8__)
+
+#define AVAILABLE_TONE_PINS 1
+#define USE_TIMER2
+
+const uint8_t PROGMEM tone_pin_to_timer_PGM[] = { 2 /*, 1 */ };
+static uint8_t tone_pins[AVAILABLE_TONE_PINS] = { 255 /*, 255 */ };
+
+#elif defined(__AVR_ATmega32U4__)
+ 
+#define AVAILABLE_TONE_PINS 1
+#define USE_TIMER3
+ 
+const uint8_t PROGMEM tone_pin_to_timer_PGM[] = { 3 /*, 1 */ };
+static uint8_t tone_pins[AVAILABLE_TONE_PINS] = { 255 /*, 255 */ };
+ 
+#else
+
+#define AVAILABLE_TONE_PINS 1
+#define USE_TIMER2
+
+// Leave timer 0 to last.
+const uint8_t PROGMEM tone_pin_to_timer_PGM[] = { 2 /*, 1, 0 */ };
+static uint8_t tone_pins[AVAILABLE_TONE_PINS] = { 255 /*, 255, 255 */ };
+
+#endif
+
+
+
+static int8_t toneBegin(uint8_t _pin)
+{
+  int8_t _timer = -1;
+
+  // if we're already using the pin, the timer should be configured.  
+  for (int i = 0; i < AVAILABLE_TONE_PINS; i++) {
+    if (tone_pins[i] == _pin) {
+      return pgm_read_byte(tone_pin_to_timer_PGM + i);
+    }
+  }
+  
+  // search for an unused timer.
+  for (int i = 0; i < AVAILABLE_TONE_PINS; i++) {
+    if (tone_pins[i] == 255) {
+      tone_pins[i] = _pin;
+      _timer = pgm_read_byte(tone_pin_to_timer_PGM + i);
+      break;
+    }
+  }
+  
+  if (_timer != -1)
+  {
+    // Set timer specific stuff
+    // All timers in CTC mode
+    // 8 bit timers will require changing prescalar values,
+    // whereas 16 bit timers are set to either ck/1 or ck/64 prescalar
+    switch (_timer)
+    {
+      #if defined(TCCR0A) && defined(TCCR0B) && defined(WGM01)
+      case 0:
+        // 8 bit timer
+        TCCR0A = 0;
+        TCCR0B = 0;
+        bitWrite(TCCR0A, WGM01, 1);
+        bitWrite(TCCR0B, CS00, 1);
+        timer0_pin_port = portOutputRegister(digitalPinToPort(_pin));
+        timer0_pin_mask = digitalPinToBitMask(_pin);
+        break;
+      #endif
+
+      #if defined(TCCR1A) && defined(TCCR1B) && defined(WGM12)
+      case 1:
+        // 16 bit timer
+        TCCR1A = 0;
+        TCCR1B = 0;
+        bitWrite(TCCR1B, WGM12, 1);
+        bitWrite(TCCR1B, CS10, 1);
+        timer1_pin_port = portOutputRegister(digitalPinToPort(_pin));
+        timer1_pin_mask = digitalPinToBitMask(_pin);
+        break;
+      #endif
+
+      #if defined(TCCR2A) && defined(TCCR2B)
+      case 2:
+        // 8 bit timer
+        TCCR2A = 0;
+        TCCR2B = 0;
+        bitWrite(TCCR2A, WGM21, 1);
+        bitWrite(TCCR2B, CS20, 1);
+        timer2_pin_port = portOutputRegister(digitalPinToPort(_pin));
+        timer2_pin_mask = digitalPinToBitMask(_pin);
+        break;
+      #endif
+
+      #if defined(TCCR3A) && defined(TCCR3B) &&  defined(TIMSK3)
+      case 3:
+        // 16 bit timer
+        TCCR3A = 0;
+        TCCR3B = 0;
+        bitWrite(TCCR3B, WGM32, 1);
+        bitWrite(TCCR3B, CS30, 1);
+        timer3_pin_port = portOutputRegister(digitalPinToPort(_pin));
+        timer3_pin_mask = digitalPinToBitMask(_pin);
+        break;
+      #endif
+
+      #if defined(TCCR4A) && defined(TCCR4B) &&  defined(TIMSK4)
+      case 4:
+        // 16 bit timer
+        TCCR4A = 0;
+        TCCR4B = 0;
+        #if defined(WGM42)
+          bitWrite(TCCR4B, WGM42, 1);
+        #elif defined(CS43)
+          // TODO this may not be correct
+          // atmega32u4
+          bitWrite(TCCR4B, CS43, 1);
+        #endif
+        bitWrite(TCCR4B, CS40, 1);
+        timer4_pin_port = portOutputRegister(digitalPinToPort(_pin));
+        timer4_pin_mask = digitalPinToBitMask(_pin);
+        break;
+      #endif
+
+      #if defined(TCCR5A) && defined(TCCR5B) &&  defined(TIMSK5)
+      case 5:
+        // 16 bit timer
+        TCCR5A = 0;
+        TCCR5B = 0;
+        bitWrite(TCCR5B, WGM52, 1);
+        bitWrite(TCCR5B, CS50, 1);
+        timer5_pin_port = portOutputRegister(digitalPinToPort(_pin));
+        timer5_pin_mask = digitalPinToBitMask(_pin);
+        break;
+      #endif
+    }
+  }
+
+  return _timer;
+}
+
+
+
+// frequency (in hertz) and duration (in milliseconds).
+
+void tone(uint8_t _pin, unsigned int frequency, unsigned long duration)
+{
+  uint8_t prescalarbits = 0b001;
+  long toggle_count = 0;
+  uint32_t ocr = 0;
+  int8_t _timer;
+
+  _timer = toneBegin(_pin);
+
+  if (_timer >= 0)
+  {
+    // Set the pinMode as OUTPUT
+    pinMode(_pin, OUTPUT);
+    
+    // if we are using an 8 bit timer, scan through prescalars to find the best fit
+    if (_timer == 0 || _timer == 2)
+    {
+      ocr = F_CPU / frequency / 2 - 1;
+      prescalarbits = 0b001;  // ck/1: same for both timers
+      if (ocr > 255)
+      {
+        ocr = F_CPU / frequency / 2 / 8 - 1;
+        prescalarbits = 0b010;  // ck/8: same for both timers
+
+        if (_timer == 2 && ocr > 255)
+        {
+          ocr = F_CPU / frequency / 2 / 32 - 1;
+          prescalarbits = 0b011;
+        }
+
+        if (ocr > 255)
+        {
+          ocr = F_CPU / frequency / 2 / 64 - 1;
+          prescalarbits = _timer == 0 ? 0b011 : 0b100;
+
+          if (_timer == 2 && ocr > 255)
+          {
+            ocr = F_CPU / frequency / 2 / 128 - 1;
+            prescalarbits = 0b101;
+          }
+
+          if (ocr > 255)
+          {
+            ocr = F_CPU / frequency / 2 / 256 - 1;
+            prescalarbits = _timer == 0 ? 0b100 : 0b110;
+            if (ocr > 255)
+            {
+              // can't do any better than /1024
+              ocr = F_CPU / frequency / 2 / 1024 - 1;
+              prescalarbits = _timer == 0 ? 0b101 : 0b111;
+            }
+          }
+        }
+      }
+
+#if defined(TCCR0B)
+      if (_timer == 0)
+      {
+        TCCR0B = (TCCR0B & 0b11111000) | prescalarbits;
+      }
+      else
+#endif
+#if defined(TCCR2B)
+      {
+        TCCR2B = (TCCR2B & 0b11111000) | prescalarbits;
+      }
+#else
+      {
+        // dummy place holder to make the above ifdefs work
+      }
+#endif
+    }
+    else
+    {
+      // two choices for the 16 bit timers: ck/1 or ck/64
+      ocr = F_CPU / frequency / 2 - 1;
+
+      prescalarbits = 0b001;
+      if (ocr > 0xffff)
+      {
+        ocr = F_CPU / frequency / 2 / 64 - 1;
+        prescalarbits = 0b011;
+      }
+
+      if (_timer == 1)
+      {
+#if defined(TCCR1B)
+        TCCR1B = (TCCR1B & 0b11111000) | prescalarbits;
+#endif
+      }
+#if defined(TCCR3B)
+      else if (_timer == 3)
+        TCCR3B = (TCCR3B & 0b11111000) | prescalarbits;
+#endif
+#if defined(TCCR4B)
+      else if (_timer == 4)
+        TCCR4B = (TCCR4B & 0b11111000) | prescalarbits;
+#endif
+#if defined(TCCR5B)
+      else if (_timer == 5)
+        TCCR5B = (TCCR5B & 0b11111000) | prescalarbits;
+#endif
+
+    }
+    
+
+    // Calculate the toggle count
+    if (duration > 0)
+    {
+      toggle_count = 2 * frequency * duration / 1000;
+    }
+    else
+    {
+      toggle_count = -1;
+    }
+
+    // Set the OCR for the given timer,
+    // set the toggle count,
+    // then turn on the interrupts
+    switch (_timer)
+    {
+
+#if defined(OCR0A) && defined(TIMSK0) && defined(OCIE0A)
+      case 0:
+        OCR0A = ocr;
+        timer0_toggle_count = toggle_count;
+        bitWrite(TIMSK0, OCIE0A, 1);
+        break;
+#endif
+
+      case 1:
+#if defined(OCR1A) && defined(TIMSK1) && defined(OCIE1A)
+        OCR1A = ocr;
+        timer1_toggle_count = toggle_count;
+        bitWrite(TIMSK1, OCIE1A, 1);
+#elif defined(OCR1A) && defined(TIMSK) && defined(OCIE1A)
+        // this combination is for at least the ATmega32
+        OCR1A = ocr;
+        timer1_toggle_count = toggle_count;
+        bitWrite(TIMSK, OCIE1A, 1);
+#endif
+        break;
+
+#if defined(OCR2A) && defined(TIMSK2) && defined(OCIE2A)
+      case 2:
+        OCR2A = ocr;
+        timer2_toggle_count = toggle_count;
+        bitWrite(TIMSK2, OCIE2A, 1);
+        break;
+#endif
+
+#if defined(OCR3A) && defined(TIMSK3) && defined(OCIE3A)
+      case 3:
+        OCR3A = ocr;
+        timer3_toggle_count = toggle_count;
+        bitWrite(TIMSK3, OCIE3A, 1);
+        break;
+#endif
+
+#if defined(OCR4A) && defined(TIMSK4) && defined(OCIE4A)
+      case 4:
+        OCR4A = ocr;
+        timer4_toggle_count = toggle_count;
+        bitWrite(TIMSK4, OCIE4A, 1);
+        break;
+#endif
+
+#if defined(OCR5A) && defined(TIMSK5) && defined(OCIE5A)
+      case 5:
+        OCR5A = ocr;
+        timer5_toggle_count = toggle_count;
+        bitWrite(TIMSK5, OCIE5A, 1);
+        break;
+#endif
+
+    }
+  }
+}
+
+
+// XXX: this function only works properly for timer 2 (the only one we use
+// currently).  for the others, it should end the tone, but won't restore
+// proper PWM functionality for the timer.
+void disableTimer(uint8_t _timer)
+{
+  switch (_timer)
+  {
+    case 0:
+      #if defined(TIMSK0)
+        TIMSK0 = 0;
+      #elif defined(TIMSK)
+        TIMSK = 0; // atmega32
+      #endif
+      break;
+
+#if defined(TIMSK1) && defined(OCIE1A)
+    case 1:
+      bitWrite(TIMSK1, OCIE1A, 0);
+      break;
+#endif
+
+    case 2:
+      #if defined(TIMSK2) && defined(OCIE2A)
+        bitWrite(TIMSK2, OCIE2A, 0); // disable interrupt
+      #endif
+      #if defined(TCCR2A) && defined(WGM20)
+        TCCR2A = (1 << WGM20);
+      #endif
+      #if defined(TCCR2B) && defined(CS22)
+        TCCR2B = (TCCR2B & 0b11111000) | (1 << CS22);
+      #endif
+      #if defined(OCR2A)
+        OCR2A = 0;
+      #endif
+      break;
+
+#if defined(TIMSK3) && defined(OCIE3A)
+    case 3:
+      bitWrite(TIMSK3, OCIE3A, 0);
+      break;
+#endif
+
+#if defined(TIMSK4) && defined(OCIE4A)
+    case 4:
+      bitWrite(TIMSK4, OCIE4A, 0);
+      break;
+#endif
+
+#if defined(TIMSK5) && defined(OCIE5A)
+    case 5:
+      bitWrite(TIMSK5, OCIE5A, 0);
+      break;
+#endif
+  }
+}
+
+
+void noTone(uint8_t _pin)
+{
+  int8_t _timer = -1;
+  
+  for (int i = 0; i < AVAILABLE_TONE_PINS; i++) {
+    if (tone_pins[i] == _pin) {
+      _timer = pgm_read_byte(tone_pin_to_timer_PGM + i);
+      tone_pins[i] = 255;
+      break;
+    }
+  }
+  
+  disableTimer(_timer);
+
+  digitalWrite(_pin, 0);
+}
+
+#ifdef USE_TIMER0
+ISR(TIMER0_COMPA_vect)
+{
+  if (timer0_toggle_count != 0)
+  {
+    // toggle the pin
+    *timer0_pin_port ^= timer0_pin_mask;
+
+    if (timer0_toggle_count > 0)
+      timer0_toggle_count--;
+  }
+  else
+  {
+    disableTimer(0);
+    *timer0_pin_port &= ~(timer0_pin_mask);  // keep pin low after stop
+  }
+}
+#endif
+
+
+#ifdef USE_TIMER1
+ISR(TIMER1_COMPA_vect)
+{
+  if (timer1_toggle_count != 0)
+  {
+    // toggle the pin
+    *timer1_pin_port ^= timer1_pin_mask;
+
+    if (timer1_toggle_count > 0)
+      timer1_toggle_count--;
+  }
+  else
+  {
+    disableTimer(1);
+    *timer1_pin_port &= ~(timer1_pin_mask);  // keep pin low after stop
+  }
+}
+#endif
+
+
+#ifdef USE_TIMER2
+ISR(TIMER2_COMPA_vect)
+{
+
+  if (timer2_toggle_count != 0)
+  {
+    // toggle the pin
+    *timer2_pin_port ^= timer2_pin_mask;
+
+    if (timer2_toggle_count > 0)
+      timer2_toggle_count--;
+  }
+  else
+  {
+    // need to call noTone() so that the tone_pins[] entry is reset, so the
+    // timer gets initialized next time we call tone().
+    // XXX: this assumes timer 2 is always the first one used.
+    noTone(tone_pins[0]);
+//    disableTimer(2);
+//    *timer2_pin_port &= ~(timer2_pin_mask);  // keep pin low after stop
+  }
+}
+#endif
+
+
+#ifdef USE_TIMER3
+ISR(TIMER3_COMPA_vect)
+{
+  if (timer3_toggle_count != 0)
+  {
+    // toggle the pin
+    *timer3_pin_port ^= timer3_pin_mask;
+
+    if (timer3_toggle_count > 0)
+      timer3_toggle_count--;
+  }
+  else
+  {
+    disableTimer(3);
+    *timer3_pin_port &= ~(timer3_pin_mask);  // keep pin low after stop
+  }
+}
+#endif
+
+
+#ifdef USE_TIMER4
+ISR(TIMER4_COMPA_vect)
+{
+  if (timer4_toggle_count != 0)
+  {
+    // toggle the pin
+    *timer4_pin_port ^= timer4_pin_mask;
+
+    if (timer4_toggle_count > 0)
+      timer4_toggle_count--;
+  }
+  else
+  {
+    disableTimer(4);
+    *timer4_pin_port &= ~(timer4_pin_mask);  // keep pin low after stop
+  }
+}
+#endif
+
+
+#ifdef USE_TIMER5
+ISR(TIMER5_COMPA_vect)
+{
+  if (timer5_toggle_count != 0)
+  {
+    // toggle the pin
+    *timer5_pin_port ^= timer5_pin_mask;
+
+    if (timer5_toggle_count > 0)
+      timer5_toggle_count--;
+  }
+  else
+  {
+    disableTimer(5);
+    *timer5_pin_port &= ~(timer5_pin_mask);  // keep pin low after stop
+  }
+}
+#endif

cores/arduino/USBAPI.h

@@ -0,0 +1,209 @@
+/*
+  USBAPI.h
+  Copyright (c) 2005-2014 Arduino.  All right reserved.
+
+  This library is free software; you can redistribute it and/or
+  modify it under the terms of the GNU Lesser General Public
+  License as published by the Free Software Foundation; either
+  version 2.1 of the License, or (at your option) any later version.
+
+  This library 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
+  Lesser General Public License for more details.
+
+  You should have received a copy of the GNU Lesser General Public
+  License along with this library; if not, write to the Free Software
+  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
+*/
+
+#ifndef __USBAPI__
+#define __USBAPI__
+
+#include <inttypes.h>
+#include <avr/pgmspace.h>
+#include <avr/eeprom.h>
+#include <avr/interrupt.h>
+#include <util/delay.h>
+
+typedef unsigned char u8;
+typedef unsigned short u16;
+typedef unsigned long u32;
+
+#include "Arduino.h"
+
+// This definitions is useful if you want to reduce the EP_SIZE to 16
+// at the moment only 64 and 16 as EP_SIZE for all EPs are supported except the control endpoint
+#ifndef USB_EP_SIZE
+#define USB_EP_SIZE 64
+#endif
+
+#if defined(USBCON)
+
+#include "USBDesc.h"
+#include "USBCore.h"
+
+//================================================================================
+//================================================================================
+//	USB
+
+#define EP_TYPE_CONTROL				(0x00)
+#define EP_TYPE_BULK_IN				((1<<EPTYPE1) | (1<<EPDIR))
+#define EP_TYPE_BULK_OUT			(1<<EPTYPE1)
+#define EP_TYPE_INTERRUPT_IN		((1<<EPTYPE1) | (1<<EPTYPE0) | (1<<EPDIR))
+#define EP_TYPE_INTERRUPT_OUT		((1<<EPTYPE1) | (1<<EPTYPE0))
+#define EP_TYPE_ISOCHRONOUS_IN		((1<<EPTYPE0) | (1<<EPDIR))
+#define EP_TYPE_ISOCHRONOUS_OUT		(1<<EPTYPE0)
+
+class USBDevice_
+{
+public:
+	USBDevice_();
+	bool configured();
+
+	void attach();
+	void detach();	// Serial port goes down too...
+	void poll();
+	bool wakeupHost(); // returns false, when wakeup cannot be processed
+
+	bool isSuspended();
+};
+extern USBDevice_ USBDevice;
+
+//================================================================================
+//================================================================================
+//	Serial over CDC (Serial1 is the physical port)
+
+struct ring_buffer;
+
+#ifndef SERIAL_BUFFER_SIZE
+#if ((RAMEND - RAMSTART) < 1023)
+#define SERIAL_BUFFER_SIZE 16
+#else
+#define SERIAL_BUFFER_SIZE 64
+#endif
+#endif
+#if (SERIAL_BUFFER_SIZE>256)
+#error Please lower the CDC Buffer size
+#endif
+
+class Serial_ : public Stream
+{
+private:
+	int peek_buffer;
+public:
+	Serial_() { peek_buffer = -1; };
+	void begin(unsigned long);
+	void begin(unsigned long, uint8_t);
+	void end(void);
+
+	virtual int available(void);
+	virtual int peek(void);
+	virtual int read(void);
+	virtual int availableForWrite(void);
+	virtual void flush(void);
+	virtual size_t write(uint8_t);
+	virtual size_t write(const uint8_t*, size_t);
+	using Print::write; // pull in write(str) and write(buf, size) from Print
+	operator bool();
+
+	volatile uint8_t _rx_buffer_head;
+	volatile uint8_t _rx_buffer_tail;
+	unsigned char _rx_buffer[SERIAL_BUFFER_SIZE];
+
+	// This method allows processing "SEND_BREAK" requests sent by
+	// the USB host. Those requests indicate that the host wants to
+	// send a BREAK signal and are accompanied by a single uint16_t
+	// value, specifying the duration of the break. The value 0
+	// means to end any current break, while the value 0xffff means
+	// to start an indefinite break.
+	// readBreak() will return the value of the most recent break
+	// request, but will return it at most once, returning -1 when
+	// readBreak() is called again (until another break request is
+	// received, which is again returned once).
+	// This also mean that if two break requests are received
+	// without readBreak() being called in between, the value of the
+	// first request is lost.
+	// Note that the value returned is a long, so it can return
+	// 0-0xffff as well as -1.
+	int32_t readBreak();
+
+	// These return the settings specified by the USB host for the
+	// serial port. These aren't really used, but are offered here
+	// in case a sketch wants to act on these settings.
+	uint32_t baud();
+	uint8_t stopbits();
+	uint8_t paritytype();
+	uint8_t numbits();
+	bool dtr();
+	bool rts();
+	enum {
+		ONE_STOP_BIT = 0,
+		ONE_AND_HALF_STOP_BIT = 1,
+		TWO_STOP_BITS = 2,
+	};
+	enum {
+		NO_PARITY = 0,
+		ODD_PARITY = 1,
+		EVEN_PARITY = 2,
+		MARK_PARITY = 3,
+		SPACE_PARITY = 4,
+	};
+
+};
+extern Serial_ Serial;
+
+#define HAVE_CDCSERIAL
+
+//================================================================================
+//================================================================================
+//  Low level API
+
+typedef struct
+{
+	uint8_t bmRequestType;
+	uint8_t bRequest;
+	uint8_t wValueL;
+	uint8_t wValueH;
+	uint16_t wIndex;
+	uint16_t wLength;
+} USBSetup;
+
+//================================================================================
+//================================================================================
+//	MSC 'Driver'
+
+int		MSC_GetInterface(uint8_t* interfaceNum);
+int		MSC_GetDescriptor(int i);
+bool	MSC_Setup(USBSetup& setup);
+bool	MSC_Data(uint8_t rx,uint8_t tx);
+
+//================================================================================
+//================================================================================
+//	CSC 'Driver'
+
+int		CDC_GetInterface(uint8_t* interfaceNum);
+int		CDC_GetDescriptor(int i);
+bool	CDC_Setup(USBSetup& setup);
+
+//================================================================================
+//================================================================================
+
+#define TRANSFER_PGM		0x80
+#define TRANSFER_RELEASE	0x40
+#define TRANSFER_ZERO		0x20
+
+int USB_SendControl(uint8_t flags, const void* d, int len);
+int USB_RecvControl(void* d, int len);
+int USB_RecvControlLong(void* d, int len);
+
+uint8_t	USB_Available(uint8_t ep);
+uint8_t USB_SendSpace(uint8_t ep);
+int USB_Send(uint8_t ep, const void* data, int len);	// blocking
+int USB_Recv(uint8_t ep, void* data, int len);		// non-blocking
+int USB_Recv(uint8_t ep);							// non-blocking
+void USB_Flush(uint8_t ep);
+
+#endif
+
+#endif /* if defined(USBCON) */

cores/arduino/USBCore.cpp

@@ -0,0 +1,879 @@
+
+
+/* Copyright (c) 2010, Peter Barrett
+** Sleep/Wakeup support added by Michael Dreher
+**  
+** Permission to use, copy, modify, and/or distribute this software for  
+** any purpose with or without fee is hereby granted, provided that the  
+** above copyright notice and this permission notice appear in all copies.  
+** 
+** THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL  
+** WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED  
+** WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR  
+** BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES  
+** OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS,  
+** WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION,  
+** ARISING OUT OF OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS  
+** SOFTWARE.  
+*/
+
+#include "USBAPI.h"
+#include "PluggableUSB.h"
+#include <stdlib.h>
+
+#if defined(USBCON)
+
+/** Pulse generation counters to keep track of the number of milliseconds remaining for each pulse type */
+#define TX_RX_LED_PULSE_MS 100
+volatile u8 TxLEDPulse; /**< Milliseconds remaining for data Tx LED pulse */
+volatile u8 RxLEDPulse; /**< Milliseconds remaining for data Rx LED pulse */
+
+//==================================================================
+//==================================================================
+
+extern const u16 STRING_LANGUAGE[] PROGMEM;
+extern const u8 STRING_PRODUCT[] PROGMEM;
+extern const u8 STRING_MANUFACTURER[] PROGMEM;
+extern const DeviceDescriptor USB_DeviceDescriptorIAD PROGMEM;
+
+const u16 STRING_LANGUAGE[2] = {
+	(3<<8) | (2+2),
+	0x0409	// English
+};
+
+#ifndef USB_PRODUCT
+// If no product is provided, use USB IO Board
+#define USB_PRODUCT     "USB IO Board"
+#endif
+
+const u8 STRING_PRODUCT[] PROGMEM = USB_PRODUCT;
+
+#if USB_VID == 0x2341
+#  if defined(USB_MANUFACTURER)
+#    undef USB_MANUFACTURER
+#  endif
+#  define USB_MANUFACTURER "Arduino LLC"
+#elif USB_VID == 0x1b4f
+#  if defined(USB_MANUFACTURER)
+#    undef USB_MANUFACTURER
+#  endif
+#  define USB_MANUFACTURER "SparkFun"
+#elif !defined(USB_MANUFACTURER)
+// Fall through to unknown if no manufacturer name was provided in a macro
+#  define USB_MANUFACTURER "Unknown"
+#endif
+
+const u8 STRING_MANUFACTURER[] PROGMEM = USB_MANUFACTURER;
+
+
+#define DEVICE_CLASS 0x02
+
+//	DEVICE DESCRIPTOR
+
+#ifdef CDC_ENABLED
+const DeviceDescriptor USB_DeviceDescriptorIAD =
+	D_DEVICE(0xEF,0x02,0x01,64,USB_VID,USB_PID,0x100,IMANUFACTURER,IPRODUCT,ISERIAL,1);
+#else // CDC_DISABLED
+// The default descriptor uses USB class OxEF, subclass 0x02 with protocol 1
+// which means "Interface Association Descriptor" - that's needed for the CDC,
+// but doesn't make much sense as a default for custom devices when CDC is disabled.
+// (0x00 means "Use class information in the Interface Descriptors" which should be generally ok)
+const DeviceDescriptor USB_DeviceDescriptorIAD =
+	D_DEVICE(0x00,0x00,0x00,64,USB_VID,USB_PID,0x100,IMANUFACTURER,IPRODUCT,ISERIAL,1);
+#endif
+
+//==================================================================
+//==================================================================
+
+volatile u8 _usbConfiguration = 0;
+volatile u8 _usbCurrentStatus = 0; // meaning of bits see usb_20.pdf, Figure 9-4. Information Returned by a GetStatus() Request to a Device
+volatile u8 _usbSuspendState = 0; // copy of UDINT to check SUSPI and WAKEUPI bits
+
+static inline void WaitIN(void)
+{
+	while (!(UEINTX & (1<<TXINI)))
+		;
+}
+
+static inline void ClearIN(void)
+{
+	UEINTX = ~(1<<TXINI);
+}
+
+static inline void WaitOUT(void)
+{
+	while (!(UEINTX & (1<<RXOUTI)))
+		;
+}
+
+static inline u8 WaitForINOrOUT()
+{
+	while (!(UEINTX & ((1<<TXINI)|(1<<RXOUTI))))
+		;
+	return (UEINTX & (1<<RXOUTI)) == 0;
+}
+
+static inline void ClearOUT(void)
+{
+	UEINTX = ~(1<<RXOUTI);
+}
+
+static inline void Recv(volatile u8* data, u8 count)
+{
+	while (count--)
+		*data++ = UEDATX;
+	
+	RXLED1;					// light the RX LED
+	RxLEDPulse = TX_RX_LED_PULSE_MS;	
+}
+
+static inline u8 Recv8()
+{
+	RXLED1;					// light the RX LED
+	RxLEDPulse = TX_RX_LED_PULSE_MS;
+
+	return UEDATX;	
+}
+
+static inline void Send8(u8 d)
+{
+	UEDATX = d;
+}
+
+static inline void SetEP(u8 ep)
+{
+	UENUM = ep;
+}
+
+static inline u8 FifoByteCount()
+{
+	return UEBCLX;
+}
+
+static inline u8 ReceivedSetupInt()
+{
+	return UEINTX & (1<<RXSTPI);
+}
+
+static inline void ClearSetupInt()
+{
+	UEINTX = ~((1<<RXSTPI) | (1<<RXOUTI) | (1<<TXINI));
+}
+
+static inline void Stall()
+{
+	UECONX = (1<<STALLRQ) | (1<<EPEN);
+}
+
+static inline u8 ReadWriteAllowed()
+{
+	return UEINTX & (1<<RWAL);
+}
+
+static inline u8 Stalled()
+{
+	return UEINTX & (1<<STALLEDI);
+}
+
+static inline u8 FifoFree()
+{
+	return UEINTX & (1<<FIFOCON);
+}
+
+static inline void ReleaseRX()
+{
+	UEINTX = 0x6B;	// FIFOCON=0 NAKINI=1 RWAL=1 NAKOUTI=0 RXSTPI=1 RXOUTI=0 STALLEDI=1 TXINI=1
+}
+
+static inline void ReleaseTX()
+{
+	UEINTX = 0x3A;	// FIFOCON=0 NAKINI=0 RWAL=1 NAKOUTI=1 RXSTPI=1 RXOUTI=0 STALLEDI=1 TXINI=0
+}
+
+static inline u8 FrameNumber()
+{
+	return UDFNUML;
+}
+
+//==================================================================
+//==================================================================
+
+u8 USBGetConfiguration(void)
+{
+	return _usbConfiguration;
+}
+
+#define USB_RECV_TIMEOUT
+class LockEP
+{
+	u8 _sreg;
+public:
+	LockEP(u8 ep) : _sreg(SREG)
+	{
+		cli();
+		SetEP(ep & 7);
+	}
+	~LockEP()
+	{
+		SREG = _sreg;
+	}
+};
+
+//	Number of bytes, assumes a rx endpoint
+u8 USB_Available(u8 ep)
+{
+	LockEP lock(ep);
+	return FifoByteCount();
+}
+
+//	Non Blocking receive
+//	Return number of bytes read
+int USB_Recv(u8 ep, void* d, int len)
+{
+	if (!_usbConfiguration || len < 0)
+		return -1;
+	
+	LockEP lock(ep);
+	u8 n = FifoByteCount();
+	len = min(n,len);
+	n = len;
+	u8* dst = (u8*)d;
+	while (n--)
+		*dst++ = Recv8();
+	if (len && !FifoByteCount())	// release empty buffer
+		ReleaseRX();
+	
+	return len;
+}
+
+//	Recv 1 byte if ready
+int USB_Recv(u8 ep)
+{
+	u8 c;
+	if (USB_Recv(ep,&c,1) != 1)
+		return -1;
+	return c;
+}
+
+//	Space in send EP
+u8 USB_SendSpace(u8 ep)
+{
+	LockEP lock(ep);
+	if (!ReadWriteAllowed())
+		return 0;
+	return USB_EP_SIZE - FifoByteCount();
+}
+
+//	Blocking Send of data to an endpoint
+int USB_Send(u8 ep, const void* d, int len)
+{
+	if (!_usbConfiguration)
+		return -1;
+
+	if (_usbSuspendState & (1<<SUSPI)) {
+		//send a remote wakeup
+		UDCON |= (1 << RMWKUP);
+	}
+
+	int r = len;
+	const u8* data = (const u8*)d;
+	u8 timeout = 250;		// 250ms timeout on send? TODO
+	bool sendZlp = false;
+
+	while (len || sendZlp)
+	{
+		u8 n = USB_SendSpace(ep);
+		if (n == 0)
+		{
+			if (!(--timeout))
+				return -1;
+			delay(1);
+			continue;
+		}
+
+		if (n > len) {
+			n = len;
+		}
+
+		{
+			LockEP lock(ep);
+			// Frame may have been released by the SOF interrupt handler
+			if (!ReadWriteAllowed())
+				continue;
+
+			len -= n;
+			if (ep & TRANSFER_ZERO)
+			{
+				while (n--)
+					Send8(0);
+			}
+			else if (ep & TRANSFER_PGM)
+			{
+				while (n--)
+					Send8(pgm_read_byte(data++));
+			}
+			else
+			{
+				while (n--)
+					Send8(*data++);
+			}
+
+			if (sendZlp) {
+				ReleaseTX();
+				sendZlp = false;
+			} else if (!ReadWriteAllowed()) { // ...release if buffer is full...
+				ReleaseTX();
+				if (len == 0) sendZlp = true;
+			} else if ((len == 0) && (ep & TRANSFER_RELEASE)) { // ...or if forced with TRANSFER_RELEASE
+				// XXX: TRANSFER_RELEASE is never used can be removed?
+				ReleaseTX();
+			}
+		}
+	}
+	TXLED1;					// light the TX LED
+	TxLEDPulse = TX_RX_LED_PULSE_MS;
+	return r;
+}
+
+u8 _initEndpoints[USB_ENDPOINTS] =
+{
+	0,                      // Control Endpoint
+
+#ifdef CDC_ENABLED
+	EP_TYPE_INTERRUPT_IN,   // CDC_ENDPOINT_ACM
+	EP_TYPE_BULK_OUT,       // CDC_ENDPOINT_OUT
+	EP_TYPE_BULK_IN,        // CDC_ENDPOINT_IN
+#endif
+
+	// Following endpoints are automatically initialized to 0
+};
+
+#define EP_SINGLE_64 0x32	// EP0
+#define EP_DOUBLE_64 0x36	// Other endpoints
+#define EP_SINGLE_16 0x12
+
+static
+void InitEP(u8 index, u8 type, u8 size)
+{
+	UENUM = index;
+	UECONX = (1<<EPEN);
+	UECFG0X = type;
+	UECFG1X = size;
+}
+
+static
+void InitEndpoints()
+{
+	for (u8 i = 1; i < sizeof(_initEndpoints) && _initEndpoints[i] != 0; i++)
+	{
+		UENUM = i;
+		UECONX = (1<<EPEN);
+		UECFG0X = _initEndpoints[i];
+#if USB_EP_SIZE == 16
+		UECFG1X = EP_SINGLE_16;
+#elif USB_EP_SIZE == 64
+		UECFG1X = EP_DOUBLE_64;
+#else
+#error Unsupported value for USB_EP_SIZE
+#endif
+	}
+	UERST = 0x7E;	// And reset them
+	UERST = 0;
+}
+
+//	Handle CLASS_INTERFACE requests
+static
+bool ClassInterfaceRequest(USBSetup& setup)
+{
+#ifdef CDC_ENABLED
+	u8 i = setup.wIndex;
+
+	if (CDC_ACM_INTERFACE == i)
+		return CDC_Setup(setup);
+#endif
+
+#ifdef PLUGGABLE_USB_ENABLED
+	return PluggableUSB().setup(setup);
+#endif
+	return false;
+}
+
+static int _cmark;
+static int _cend;
+void InitControl(int end)
+{
+	SetEP(0);
+	_cmark = 0;
+	_cend = end;
+}
+
+static
+bool SendControl(u8 d)
+{
+	if (_cmark < _cend)
+	{
+		if (!WaitForINOrOUT())
+			return false;
+		Send8(d);
+		if (!((_cmark + 1) & 0x3F))
+			ClearIN();	// Fifo is full, release this packet
+	}
+	_cmark++;
+	return true;
+}
+
+//	Clipped by _cmark/_cend
+int USB_SendControl(u8 flags, const void* d, int len)
+{
+	int sent = len;
+	const u8* data = (const u8*)d;
+	bool pgm = flags & TRANSFER_PGM;
+	while (len--)
+	{
+		u8 c = pgm ? pgm_read_byte(data++) : *data++;
+		if (!SendControl(c))
+			return -1;
+	}
+	return sent;
+}
+
+// Send a USB descriptor string. The string is stored in PROGMEM as a
+// plain ASCII string but is sent out as UTF-16 with the correct 2-byte
+// prefix
+static bool USB_SendStringDescriptor(const u8*string_P, u8 string_len, uint8_t flags) {
+        SendControl(2 + string_len * 2);
+        SendControl(3);
+        bool pgm = flags & TRANSFER_PGM;
+        for(u8 i = 0; i < string_len; i++) {
+                bool r = SendControl(pgm ? pgm_read_byte(&string_P[i]) : string_P[i]);
+                r &= SendControl(0); // high byte
+                if(!r) {
+                        return false;
+                }
+        }
+        return true;
+}
+
+//	Does not timeout or cross fifo boundaries
+int USB_RecvControl(void* d, int len)
+{
+	auto length = len;
+	while(length)
+	{
+		// Dont receive more than the USB Control EP has to offer
+		// Use fixed 64 because control EP always have 64 bytes even on 16u2.
+		auto recvLength = length;
+		if(recvLength > 64){
+			recvLength = 64;
+		}
+
+		// Write data to fit to the end (not the beginning) of the array
+		WaitOUT();
+		Recv((u8*)d + len - length, recvLength);
+		ClearOUT();
+		length -= recvLength;
+	}
+	return len;
+}
+
+static u8 SendInterfaces()
+{
+	u8 interfaces = 0;
+
+#ifdef CDC_ENABLED
+	CDC_GetInterface(&interfaces);
+#endif
+
+#ifdef PLUGGABLE_USB_ENABLED
+	PluggableUSB().getInterface(&interfaces);
+#endif
+
+	return interfaces;
+}
+
+//	Construct a dynamic configuration descriptor
+//	This really needs dynamic endpoint allocation etc
+//	TODO
+static
+bool SendConfiguration(int maxlen)
+{
+	//	Count and measure interfaces
+	InitControl(0);
+	u8 interfaces = SendInterfaces();
+	ConfigDescriptor config = D_CONFIG(_cmark + sizeof(ConfigDescriptor),interfaces);
+
+	//	Now send them
+	InitControl(maxlen);
+	USB_SendControl(0,&config,sizeof(ConfigDescriptor));
+	SendInterfaces();
+	return true;
+}
+
+static
+bool SendDescriptor(USBSetup& setup)
+{
+	u8 t = setup.wValueH;
+	if (USB_CONFIGURATION_DESCRIPTOR_TYPE == t)
+		return SendConfiguration(setup.wLength);
+
+	InitControl(setup.wLength);
+#ifdef PLUGGABLE_USB_ENABLED
+	int ret = PluggableUSB().getDescriptor(setup);
+	if (ret != 0) {
+		return (ret > 0 ? true : false);
+	}
+#endif
+
+	const u8* desc_addr = 0;
+	if (USB_DEVICE_DESCRIPTOR_TYPE == t)
+	{
+		desc_addr = (const u8*)&USB_DeviceDescriptorIAD;
+	}
+	else if (USB_STRING_DESCRIPTOR_TYPE == t)
+	{
+		if (setup.wValueL == 0) {
+			desc_addr = (const u8*)&STRING_LANGUAGE;
+		}
+		else if (setup.wValueL == IPRODUCT) {
+			return USB_SendStringDescriptor(STRING_PRODUCT, strlen(USB_PRODUCT), TRANSFER_PGM);
+		}
+		else if (setup.wValueL == IMANUFACTURER) {
+			return USB_SendStringDescriptor(STRING_MANUFACTURER, strlen(USB_MANUFACTURER), TRANSFER_PGM);
+		}
+		else if (setup.wValueL == ISERIAL) {
+#ifdef PLUGGABLE_USB_ENABLED
+			char name[ISERIAL_MAX_LEN];
+			PluggableUSB().getShortName(name);
+			return USB_SendStringDescriptor((uint8_t*)name, strlen(name), 0);
+#endif
+		}
+		else
+			return false;
+	}
+
+	if (desc_addr == 0)
+		return false;
+	u8 desc_length = pgm_read_byte(desc_addr);
+
+	USB_SendControl(TRANSFER_PGM,desc_addr,desc_length);
+	return true;
+}
+
+//	Endpoint 0 interrupt
+ISR(USB_COM_vect)
+{
+    SetEP(0);
+	if (!ReceivedSetupInt())
+		return;
+
+	USBSetup setup;
+	Recv((u8*)&setup,8);
+	ClearSetupInt();
+
+	u8 requestType = setup.bmRequestType;
+	if (requestType & REQUEST_DEVICETOHOST)
+		WaitIN();
+	else
+		ClearIN();
+
+    bool ok = true;
+	if (REQUEST_STANDARD == (requestType & REQUEST_TYPE))
+	{
+		//	Standard Requests
+		u8 r = setup.bRequest;
+		u16 wValue = setup.wValueL | (setup.wValueH << 8);
+		if (GET_STATUS == r)
+		{
+			if (requestType == (REQUEST_DEVICETOHOST | REQUEST_STANDARD | REQUEST_DEVICE))
+			{
+				Send8(_usbCurrentStatus);
+				Send8(0);
+			}
+			else
+			{
+				// TODO: handle the HALT state of an endpoint here
+				// see "Figure 9-6. Information Returned by a GetStatus() Request to an Endpoint" in usb_20.pdf for more information
+				Send8(0);
+				Send8(0);
+			}
+		}
+		else if (CLEAR_FEATURE == r)
+		{
+			if((requestType == (REQUEST_HOSTTODEVICE | REQUEST_STANDARD | REQUEST_DEVICE))
+				&& (wValue == DEVICE_REMOTE_WAKEUP))
+			{
+				_usbCurrentStatus &= ~FEATURE_REMOTE_WAKEUP_ENABLED;
+			}
+		}
+		else if (SET_FEATURE == r)
+		{
+			if((requestType == (REQUEST_HOSTTODEVICE | REQUEST_STANDARD | REQUEST_DEVICE))
+				&& (wValue == DEVICE_REMOTE_WAKEUP))
+			{
+				_usbCurrentStatus |= FEATURE_REMOTE_WAKEUP_ENABLED;
+			}
+		}
+		else if (SET_ADDRESS == r)
+		{
+			WaitIN();
+			UDADDR = setup.wValueL | (1<<ADDEN);
+		}
+		else if (GET_DESCRIPTOR == r)
+		{
+			ok = SendDescriptor(setup);
+		}
+		else if (SET_DESCRIPTOR == r)
+		{
+			ok = false;
+		}
+		else if (GET_CONFIGURATION == r)
+		{
+			Send8(1);
+		}
+		else if (SET_CONFIGURATION == r)
+		{
+			if (REQUEST_DEVICE == (requestType & REQUEST_RECIPIENT))
+			{
+				InitEndpoints();
+				_usbConfiguration = setup.wValueL;
+			} else
+				ok = false;
+		}
+		else if (GET_INTERFACE == r)
+		{
+		}
+		else if (SET_INTERFACE == r)
+		{
+		}
+	}
+	else
+	{
+		InitControl(setup.wLength);		//	Max length of transfer
+		ok = ClassInterfaceRequest(setup);
+	}
+
+	if (ok)
+		ClearIN();
+	else
+	{
+		Stall();
+	}
+}
+
+void USB_Flush(u8 ep)
+{
+	SetEP(ep);
+	if (FifoByteCount())
+		ReleaseTX();
+}
+
+static inline void USB_ClockDisable()
+{
+#if defined(OTGPADE)
+	USBCON = (USBCON & ~(1<<OTGPADE)) | (1<<FRZCLK); // freeze clock and disable VBUS Pad
+#else // u2 Series
+	USBCON = (1 << FRZCLK); // freeze clock
+#endif
+	PLLCSR &= ~(1<<PLLE);  // stop PLL
+}
+
+static inline void USB_ClockEnable()
+{
+#if defined(UHWCON)
+	UHWCON |= (1<<UVREGE);			// power internal reg
+#endif
+	USBCON = (1<<USBE) | (1<<FRZCLK);	// clock frozen, usb enabled
+
+// ATmega32U4
+#if defined(PINDIV)
+#if F_CPU == 16000000UL
+	PLLCSR |= (1<<PINDIV);                   // Need 16 MHz xtal
+#elif F_CPU == 8000000UL
+	PLLCSR &= ~(1<<PINDIV);                  // Need  8 MHz xtal
+#else
+#error "Clock rate of F_CPU not supported"
+#endif
+
+#elif defined(__AVR_AT90USB82__) || defined(__AVR_AT90USB162__) || defined(__AVR_ATmega32U2__) || defined(__AVR_ATmega16U2__) || defined(__AVR_ATmega8U2__)
+	// for the u2 Series the datasheet is confusing. On page 40 its called PINDIV and on page 290 its called PLLP0
+#if F_CPU == 16000000UL
+	// Need 16 MHz xtal
+	PLLCSR |= (1 << PLLP0);
+#elif F_CPU == 8000000UL
+	// Need 8 MHz xtal
+	PLLCSR &= ~(1 << PLLP0);
+#endif
+
+// AT90USB646, AT90USB647, AT90USB1286, AT90USB1287
+#elif defined(PLLP2)
+#if F_CPU == 16000000UL
+#if defined(__AVR_AT90USB1286__) || defined(__AVR_AT90USB1287__)
+	// For Atmel AT90USB128x only. Do not use with Atmel AT90USB64x.
+	PLLCSR = (PLLCSR & ~(1<<PLLP1)) | ((1<<PLLP2) | (1<<PLLP0)); // Need 16 MHz xtal
+#elif defined(__AVR_AT90USB646__) || defined(__AVR_AT90USB647__)
+	// For AT90USB64x only. Do not use with AT90USB128x.
+	PLLCSR = (PLLCSR & ~(1<<PLLP0)) | ((1<<PLLP2) | (1<<PLLP1)); // Need 16 MHz xtal
+#else
+#error "USB Chip not supported, please defined method of USB PLL initialization"
+#endif
+#elif F_CPU == 8000000UL
+	// for Atmel AT90USB128x and AT90USB64x
+	PLLCSR = (PLLCSR & ~(1<<PLLP2)) | ((1<<PLLP1) | (1<<PLLP0)); // Need 8 MHz xtal
+#else
+#error "Clock rate of F_CPU not supported"
+#endif
+#else
+#error "USB Chip not supported, please defined method of USB PLL initialization"
+#endif
+
+	PLLCSR |= (1<<PLLE);
+	while (!(PLLCSR & (1<<PLOCK)))		// wait for lock pll
+	{
+	}
+
+	// Some tests on specific versions of macosx (10.7.3), reported some
+	// strange behaviors when the board is reset using the serial
+	// port touch at 1200 bps. This delay fixes this behavior.
+	delay(1);
+#if defined(OTGPADE)
+	USBCON = (USBCON & ~(1<<FRZCLK)) | (1<<OTGPADE);	// start USB clock, enable VBUS Pad
+#else
+	USBCON &= ~(1 << FRZCLK);	// start USB clock
+#endif
+
+#if defined(RSTCPU)
+#if defined(LSM)
+	UDCON &= ~((1<<RSTCPU) | (1<<LSM) | (1<<RMWKUP) | (1<<DETACH));	// enable attach resistor, set full speed mode
+#else // u2 Series
+	UDCON &= ~((1 << RSTCPU) | (1 << RMWKUP) | (1 << DETACH));	// enable attach resistor, set full speed mode
+#endif
+#else
+	// AT90USB64x and AT90USB128x don't have RSTCPU
+	UDCON &= ~((1<<LSM) | (1<<RMWKUP) | (1<<DETACH));	// enable attach resistor, set full speed mode
+#endif
+}
+
+//	General interrupt
+ISR(USB_GEN_vect)
+{
+	u8 udint = UDINT;
+	UDINT &= ~((1<<EORSTI) | (1<<SOFI)); // clear the IRQ flags for the IRQs which are handled here, except WAKEUPI and SUSPI (see below)
+
+	//	End of Reset
+	if (udint & (1<<EORSTI))
+	{
+		InitEP(0,EP_TYPE_CONTROL,EP_SINGLE_64);	// init ep0
+		_usbConfiguration = 0;			// not configured yet
+		UEIENX = 1 << RXSTPE;			// Enable interrupts for ep0
+	}
+
+	//	Start of Frame - happens every millisecond so we use it for TX and RX LED one-shot timing, too
+	if (udint & (1<<SOFI))
+	{
+		USB_Flush(CDC_TX);				// Send a tx frame if found
+		
+		// check whether the one-shot period has elapsed.  if so, turn off the LED
+		if (TxLEDPulse && !(--TxLEDPulse))
+			TXLED0;
+		if (RxLEDPulse && !(--RxLEDPulse))
+			RXLED0;
+	}
+
+	// the WAKEUPI interrupt is triggered as soon as there are non-idle patterns on the data
+	// lines. Thus, the WAKEUPI interrupt can occur even if the controller is not in the "suspend" mode.
+	// Therefore the we enable it only when USB is suspended
+	if (udint & (1<<WAKEUPI))
+	{
+		UDIEN = (UDIEN & ~(1<<WAKEUPE)) | (1<<SUSPE); // Disable interrupts for WAKEUP and enable interrupts for SUSPEND
+
+		//TODO
+		// WAKEUPI shall be cleared by software (USB clock inputs must be enabled before).
+		//USB_ClockEnable();
+		UDINT &= ~(1<<WAKEUPI);
+		_usbSuspendState = (_usbSuspendState & ~(1<<SUSPI)) | (1<<WAKEUPI);
+	}
+	else if (udint & (1<<SUSPI)) // only one of the WAKEUPI / SUSPI bits can be active at time
+	{
+		UDIEN = (UDIEN & ~(1<<SUSPE)) | (1<<WAKEUPE); // Disable interrupts for SUSPEND and enable interrupts for WAKEUP
+
+		//TODO
+		//USB_ClockDisable();
+
+		UDINT &= ~((1<<WAKEUPI) | (1<<SUSPI)); // clear any already pending WAKEUP IRQs and the SUSPI request
+		_usbSuspendState = (_usbSuspendState & ~(1<<WAKEUPI)) | (1<<SUSPI);
+	}
+}
+
+//	VBUS or counting frames
+//	Any frame counting?
+u8 USBConnected()
+{
+	u8 f = UDFNUML;
+	delay(3);
+	return f != UDFNUML;
+}
+
+//=======================================================================
+//=======================================================================
+
+USBDevice_ USBDevice;
+
+USBDevice_::USBDevice_()
+{
+}
+
+void USBDevice_::attach()
+{
+	_usbConfiguration = 0;
+	_usbCurrentStatus = 0;
+	_usbSuspendState = 0;
+	USB_ClockEnable();
+
+	UDINT &= ~((1<<WAKEUPI) | (1<<SUSPI)); // clear already pending WAKEUP / SUSPEND requests
+	UDIEN = (1<<EORSTE) | (1<<SOFE) | (1<<SUSPE);	// Enable interrupts for EOR (End of Reset), SOF (start of frame) and SUSPEND
+	
+	TX_RX_LED_INIT;
+}
+
+void USBDevice_::detach()
+{
+}
+
+//	Check for interrupts
+//	TODO: VBUS detection
+bool USBDevice_::configured()
+{
+	return _usbConfiguration;
+}
+
+void USBDevice_::poll()
+{
+}
+
+bool USBDevice_::wakeupHost()
+{
+	// clear any previous wakeup request which might have been set but could be processed at that time
+	// e.g. because the host was not suspended at that time
+	UDCON &= ~(1 << RMWKUP);
+
+	if(!(UDCON & (1 << RMWKUP))
+	  && (_usbSuspendState & (1<<SUSPI))
+	  && (_usbCurrentStatus & FEATURE_REMOTE_WAKEUP_ENABLED))
+	{
+		// This short version will only work, when the device has not been suspended. Currently the
+		// Arduino core doesn't handle SUSPEND at all, so this is ok.
+		USB_ClockEnable();
+		UDCON |= (1 << RMWKUP); // send the wakeup request
+		return true;
+	}
+
+	return false;
+}
+
+bool USBDevice_::isSuspended()
+{
+	return (_usbSuspendState & (1 << SUSPI));
+}
+
+
+#endif /* if defined(USBCON) */

cores/arduino/USBCore.h

@@ -0,0 +1,304 @@
+
+// Copyright (c) 2010, Peter Barrett 
+/*
+** Permission to use, copy, modify, and/or distribute this software for  
+** any purpose with or without fee is hereby granted, provided that the  
+** above copyright notice and this permission notice appear in all copies.  
+**  
+** THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL  
+** WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED  
+** WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR  
+** BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES  
+** OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS,  
+** WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION,  
+** ARISING OUT OF OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS  
+** SOFTWARE.  
+*/
+
+#ifndef __USBCORE_H__
+#define __USBCORE_H__
+
+#include "USBAPI.h"
+
+//	Standard requests
+#define GET_STATUS			0
+#define CLEAR_FEATURE		1
+#define SET_FEATURE			3
+#define SET_ADDRESS			5
+#define GET_DESCRIPTOR		6
+#define SET_DESCRIPTOR		7
+#define GET_CONFIGURATION	8
+#define SET_CONFIGURATION	9
+#define GET_INTERFACE		10
+#define SET_INTERFACE		11
+
+
+// bmRequestType
+#define REQUEST_HOSTTODEVICE	0x00
+#define REQUEST_DEVICETOHOST	0x80
+#define REQUEST_DIRECTION		0x80
+
+#define REQUEST_STANDARD		0x00
+#define REQUEST_CLASS			0x20
+#define REQUEST_VENDOR			0x40
+#define REQUEST_TYPE			0x60
+
+#define REQUEST_DEVICE			0x00
+#define REQUEST_INTERFACE		0x01
+#define REQUEST_ENDPOINT		0x02
+#define REQUEST_OTHER			0x03
+#define REQUEST_RECIPIENT		0x03
+
+#define REQUEST_DEVICETOHOST_CLASS_INTERFACE    (REQUEST_DEVICETOHOST | REQUEST_CLASS | REQUEST_INTERFACE)
+#define REQUEST_HOSTTODEVICE_CLASS_INTERFACE    (REQUEST_HOSTTODEVICE | REQUEST_CLASS | REQUEST_INTERFACE)
+#define REQUEST_DEVICETOHOST_STANDARD_INTERFACE (REQUEST_DEVICETOHOST | REQUEST_STANDARD | REQUEST_INTERFACE)
+
+//	Class requests
+
+#define CDC_SET_LINE_CODING			0x20
+#define CDC_GET_LINE_CODING			0x21
+#define CDC_SET_CONTROL_LINE_STATE	0x22
+#define CDC_SEND_BREAK				0x23
+
+#define MSC_RESET					0xFF
+#define MSC_GET_MAX_LUN				0xFE
+
+//	Descriptors
+
+#define USB_DEVICE_DESC_SIZE 18
+#define USB_CONFIGUARTION_DESC_SIZE 9
+#define USB_INTERFACE_DESC_SIZE 9
+#define USB_ENDPOINT_DESC_SIZE 7
+
+#define USB_DEVICE_DESCRIPTOR_TYPE             1
+#define USB_CONFIGURATION_DESCRIPTOR_TYPE      2
+#define USB_STRING_DESCRIPTOR_TYPE             3
+#define USB_INTERFACE_DESCRIPTOR_TYPE          4
+#define USB_ENDPOINT_DESCRIPTOR_TYPE           5
+
+// usb_20.pdf Table 9.6 Standard Feature Selectors
+#define DEVICE_REMOTE_WAKEUP                   1
+#define ENDPOINT_HALT                          2
+#define TEST_MODE                              3
+
+// usb_20.pdf Figure 9-4. Information Returned by a GetStatus() Request to a Device
+#define FEATURE_SELFPOWERED_ENABLED     (1 << 0)
+#define FEATURE_REMOTE_WAKEUP_ENABLED   (1 << 1)
+
+#define USB_DEVICE_CLASS_COMMUNICATIONS        0x02
+#define USB_DEVICE_CLASS_HUMAN_INTERFACE       0x03
+#define USB_DEVICE_CLASS_STORAGE               0x08
+#define USB_DEVICE_CLASS_VENDOR_SPECIFIC       0xFF
+
+#define USB_CONFIG_POWERED_MASK                0x40
+#define USB_CONFIG_BUS_POWERED                 0x80
+#define USB_CONFIG_SELF_POWERED                0xC0
+#define USB_CONFIG_REMOTE_WAKEUP               0x20
+
+// bMaxPower in Configuration Descriptor
+#define USB_CONFIG_POWER_MA(mA)                ((mA)/2)
+#ifndef USB_CONFIG_POWER
+ #define USB_CONFIG_POWER                      (500)
+#endif
+
+// bEndpointAddress in Endpoint Descriptor
+#define USB_ENDPOINT_DIRECTION_MASK            0x80
+#define USB_ENDPOINT_OUT(addr)                 (lowByte((addr) | 0x00))
+#define USB_ENDPOINT_IN(addr)                  (lowByte((addr) | 0x80))
+
+#define USB_ENDPOINT_TYPE_MASK                 0x03
+#define USB_ENDPOINT_TYPE_CONTROL              0x00
+#define USB_ENDPOINT_TYPE_ISOCHRONOUS          0x01
+#define USB_ENDPOINT_TYPE_BULK                 0x02
+#define USB_ENDPOINT_TYPE_INTERRUPT            0x03
+
+#define TOBYTES(x) ((x) & 0xFF),(((x) >> 8) & 0xFF)
+
+#define CDC_V1_10                               0x0110
+#define CDC_COMMUNICATION_INTERFACE_CLASS       0x02
+
+#define CDC_CALL_MANAGEMENT                     0x01
+#define CDC_ABSTRACT_CONTROL_MODEL              0x02
+#define CDC_HEADER                              0x00
+#define CDC_ABSTRACT_CONTROL_MANAGEMENT         0x02
+#define CDC_UNION                               0x06
+#define CDC_CS_INTERFACE                        0x24
+#define CDC_CS_ENDPOINT                         0x25
+#define CDC_DATA_INTERFACE_CLASS                0x0A
+
+#define MSC_SUBCLASS_SCSI						0x06 
+#define MSC_PROTOCOL_BULK_ONLY					0x50 
+
+#ifndef USB_VERSION
+#define USB_VERSION 0x200
+#endif
+
+//	Device
+typedef struct {
+	u8 len;				// 18
+	u8 dtype;			// 1 USB_DEVICE_DESCRIPTOR_TYPE
+	u16 usbVersion;		// 0x200 or 0x210
+	u8	deviceClass;
+	u8	deviceSubClass;
+	u8	deviceProtocol;
+	u8	packetSize0;	// Packet 0
+	u16	idVendor;
+	u16	idProduct;
+	u16	deviceVersion;	// 0x100
+	u8	iManufacturer;
+	u8	iProduct;
+	u8	iSerialNumber;
+	u8	bNumConfigurations;
+} DeviceDescriptor;
+
+//	Config
+typedef struct {
+	u8	len;			// 9
+	u8	dtype;			// 2
+	u16 clen;			// total length
+	u8	numInterfaces;
+	u8	config;
+	u8	iconfig;
+	u8	attributes;
+	u8	maxPower;
+} ConfigDescriptor;
+
+//	String
+
+//	Interface
+typedef struct
+{
+	u8 len;		// 9
+	u8 dtype;	// 4
+	u8 number;
+	u8 alternate;
+	u8 numEndpoints;
+	u8 interfaceClass;
+	u8 interfaceSubClass;
+	u8 protocol;
+	u8 iInterface;
+} InterfaceDescriptor;
+
+//	Endpoint
+typedef struct
+{
+	u8 len;		// 7
+	u8 dtype;	// 5
+	u8 addr;
+	u8 attr;
+	u16 packetSize;
+	u8 interval;
+} EndpointDescriptor;
+
+// Interface Association Descriptor
+// Used to bind 2 interfaces together in CDC composite device
+typedef struct
+{
+	u8 len;				// 8
+	u8 dtype;			// 11
+	u8 firstInterface;
+	u8 interfaceCount;
+	u8 functionClass;
+	u8 funtionSubClass;
+	u8 functionProtocol;
+	u8 iInterface;
+} IADDescriptor;
+
+//	CDC CS interface descriptor
+typedef struct
+{
+	u8 len;		// 5
+	u8 dtype;	// 0x24
+	u8 subtype;
+	u8 d0;
+	u8 d1;
+} CDCCSInterfaceDescriptor;
+
+typedef struct
+{
+	u8 len;		// 4
+	u8 dtype;	// 0x24
+	u8 subtype;
+	u8 d0;
+} CDCCSInterfaceDescriptor4;
+
+typedef struct 
+{
+    u8	len;
+    u8 	dtype;		// 0x24
+    u8 	subtype;	// 1
+    u8 	bmCapabilities;
+    u8 	bDataInterface;
+} CMFunctionalDescriptor;
+	
+typedef struct 
+{
+    u8	len;
+    u8 	dtype;		// 0x24
+    u8 	subtype;	// 1
+    u8 	bmCapabilities;
+} ACMFunctionalDescriptor;
+
+typedef struct 
+{
+	//	IAD
+	IADDescriptor				iad;	// Only needed on compound device
+
+	//	Control
+	InterfaceDescriptor			cif;	// 
+	CDCCSInterfaceDescriptor	header;
+	CMFunctionalDescriptor		callManagement;			// Call Management
+	ACMFunctionalDescriptor		controlManagement;		// ACM
+	CDCCSInterfaceDescriptor	functionalDescriptor;	// CDC_UNION
+	EndpointDescriptor			cifin;
+
+	//	Data
+	InterfaceDescriptor			dif;
+	EndpointDescriptor			in;
+	EndpointDescriptor			out;
+} CDCDescriptor;
+
+typedef struct 
+{
+	InterfaceDescriptor			msc;
+	EndpointDescriptor			in;
+	EndpointDescriptor			out;
+} MSCDescriptor;
+
+
+#define D_DEVICE(_class,_subClass,_proto,_packetSize0,_vid,_pid,_version,_im,_ip,_is,_configs) \
+	{ 18, 1, USB_VERSION, _class,_subClass,_proto,_packetSize0,_vid,_pid,_version,_im,_ip,_is,_configs }
+
+#define D_CONFIG(_totalLength,_interfaces) \
+	{ 9, 2, _totalLength,_interfaces, 1, 0, USB_CONFIG_BUS_POWERED | USB_CONFIG_REMOTE_WAKEUP, USB_CONFIG_POWER_MA(USB_CONFIG_POWER) }
+
+#define D_INTERFACE(_n,_numEndpoints,_class,_subClass,_protocol) \
+	{ 9, 4, _n, 0, _numEndpoints, _class,_subClass, _protocol, 0 }
+
+#define D_ENDPOINT(_addr,_attr,_packetSize, _interval) \
+	{ 7, 5, _addr,_attr,_packetSize, _interval }
+
+#define D_IAD(_firstInterface, _count, _class, _subClass, _protocol) \
+	{ 8, 11, _firstInterface, _count, _class, _subClass, _protocol, 0 }
+
+#define D_CDCCS(_subtype,_d0,_d1)	{ 5, 0x24, _subtype, _d0, _d1 }
+#define D_CDCCS4(_subtype,_d0)		{ 4, 0x24, _subtype, _d0 }
+
+// Bootloader related fields
+// Old Caterina bootloader places the MAGIC key into unsafe RAM locations (it can be rewritten
+// by the running sketch before to actual reboot).
+// Newer bootloaders, recognizable by the LUFA "signature" at the end of the flash, can handle both
+// the usafe and the safe location.
+#ifndef MAGIC_KEY
+#define MAGIC_KEY 0x7777
+#endif
+
+#ifndef MAGIC_KEY_POS
+#define MAGIC_KEY_POS 0x0800
+#endif
+
+#ifndef NEW_LUFA_SIGNATURE
+#define NEW_LUFA_SIGNATURE 0xDCFB
+#endif
+
+#endif

cores/arduino/USBDesc.h

@@ -0,0 +1,63 @@
+/*
+   Copyright (c) 2011, Peter Barrett
+   Copyright (c) 2015, Arduino LLC
+
+   Permission to use, copy, modify, and/or distribute this software for
+   any purpose with or without fee is hereby granted, provided that the
+   above copyright notice and this permission notice appear in all copies.
+
+   THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL
+   WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED
+   WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR
+   BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES
+   OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS,
+   WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION,
+   ARISING OUT OF OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS
+   SOFTWARE.
+ */
+
+#define PLUGGABLE_USB_ENABLED
+
+#if defined(EPRST6)
+#define USB_ENDPOINTS 7 // AtMegaxxU4
+#else
+#define USB_ENDPOINTS 5 // AtMegaxxU2
+#endif
+
+#define ISERIAL_MAX_LEN     20
+
+// Uncomment the following line or pass -DCDC_DISABLED to the compiler
+// to disable CDC (serial console via USB).
+// That's useful if you want to create an USB device (like an USB Boot Keyboard)
+// that works even with problematic devices (like KVM switches).
+// Keep in mind that with this change you'll have to use the Arduino's
+// reset button to be able to flash it.
+//#define CDC_DISABLED
+
+#ifndef CDC_DISABLED
+#define CDC_ENABLED
+#endif
+
+#ifdef CDC_ENABLED
+#define CDC_INTERFACE_COUNT	2
+#define CDC_ENPOINT_COUNT	3
+#else // CDC_DISABLED
+#define CDC_INTERFACE_COUNT	0
+#define CDC_ENPOINT_COUNT	0
+#endif
+
+#define CDC_ACM_INTERFACE	0	// CDC ACM
+#define CDC_DATA_INTERFACE	1	// CDC Data
+#define CDC_FIRST_ENDPOINT	1
+#define CDC_ENDPOINT_ACM	(CDC_FIRST_ENDPOINT)							// CDC First
+#define CDC_ENDPOINT_OUT	(CDC_FIRST_ENDPOINT+1)
+#define CDC_ENDPOINT_IN		(CDC_FIRST_ENDPOINT+2)
+
+#define INTERFACE_COUNT		(MSC_INTERFACE + MSC_INTERFACE_COUNT)
+
+#define CDC_RX CDC_ENDPOINT_OUT
+#define CDC_TX CDC_ENDPOINT_IN
+
+#define IMANUFACTURER   1
+#define IPRODUCT        2
+#define ISERIAL         3

cores/arduino/Udp.h

@@ -0,0 +1,89 @@
+/*
+ *  Udp.cpp: Library to send/receive UDP packets.
+ *
+ * NOTE: UDP is fast, but has some important limitations (thanks to Warren Gray for mentioning these)
+ * 1) UDP does not guarantee the order in which assembled UDP packets are received. This
+ * might not happen often in practice, but in larger network topologies, a UDP
+ * packet can be received out of sequence. 
+ * 2) UDP does not guard against lost packets - so packets *can* disappear without the sender being
+ * aware of it. Again, this may not be a concern in practice on small local networks.
+ * For more information, see http://www.cafeaulait.org/course/week12/35.html
+ *
+ * MIT License:
+ * Copyright (c) 2008 Bjoern Hartmann
+ * Permission is hereby granted, free of charge, to any person obtaining a copy
+ * of this software and associated documentation files (the "Software"), to deal
+ * in the Software without restriction, including without limitation the rights
+ * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
+ * copies of the Software, and to permit persons to whom the Software is
+ * furnished to do so, subject to the following conditions:
+ * 
+ * The above copyright notice and this permission notice shall be included in
+ * all copies or substantial portions of the Software.
+ * 
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
+ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
+ * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
+ * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
+ * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
+ * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
+ * THE SOFTWARE.
+ *
+ * bjoern@cs.stanford.edu 12/30/2008
+ */
+
+#ifndef udp_h
+#define udp_h
+
+#include <Stream.h>
+#include <IPAddress.h>
+
+class UDP : public Stream {
+
+public:
+  virtual uint8_t begin(uint16_t) =0;  // initialize, start listening on specified port. Returns 1 if successful, 0 if there are no sockets available to use
+  virtual uint8_t beginMulticast(IPAddress, uint16_t) { return 0; }  // initialize, start listening on specified multicast IP address and port. Returns 1 if successful, 0 on failure
+  virtual void stop() =0;  // Finish with the UDP socket
+
+  // Sending UDP packets
+  
+  // Start building up a packet to send to the remote host specific in ip and port
+  // Returns 1 if successful, 0 if there was a problem with the supplied IP address or port
+  virtual int beginPacket(IPAddress ip, uint16_t port) =0;
+  // Start building up a packet to send to the remote host specific in host and port
+  // Returns 1 if successful, 0 if there was a problem resolving the hostname or port
+  virtual int beginPacket(const char *host, uint16_t port) =0;
+  // Finish off this packet and send it
+  // Returns 1 if the packet was sent successfully, 0 if there was an error
+  virtual int endPacket() =0;
+  // Write a single byte into the packet
+  virtual size_t write(uint8_t) =0;
+  // Write size bytes from buffer into the packet
+  virtual size_t write(const uint8_t *buffer, size_t size) =0;
+
+  // Start processing the next available incoming packet
+  // Returns the size of the packet in bytes, or 0 if no packets are available
+  virtual int parsePacket() =0;
+  // Number of bytes remaining in the current packet
+  virtual int available() =0;
+  // Read a single byte from the current packet
+  virtual int read() =0;
+  // Read up to len bytes from the current packet and place them into buffer
+  // Returns the number of bytes read, or 0 if none are available
+  virtual int read(unsigned char* buffer, size_t len) =0;
+  // Read up to len characters from the current packet and place them into buffer
+  // Returns the number of characters read, or 0 if none are available
+  virtual int read(char* buffer, size_t len) =0;
+  // Return the next byte from the current packet without moving on to the next byte
+  virtual int peek() =0;
+  virtual void flush() =0;	// Finish reading the current packet
+
+  // Return the IP address of the host who sent the current incoming packet
+  virtual IPAddress remoteIP() =0;
+  // Return the port of the host who sent the current incoming packet
+  virtual uint16_t remotePort() =0;
+protected:
+  uint8_t* rawIPAddress(IPAddress& addr) { return addr.raw_address(); };
+};
+
+#endif

cores/arduino/WCharacter.h

@@ -0,0 +1,168 @@
+/*
+ WCharacter.h - Character utility functions for Wiring & Arduino
+ Copyright (c) 2010 Hernando Barragan.  All right reserved.
+ 
+ This library is free software; you can redistribute it and/or
+ modify it under the terms of the GNU Lesser General Public
+ License as published by the Free Software Foundation; either
+ version 2.1 of the License, or (at your option) any later version.
+ 
+ This library 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
+ Lesser General Public License for more details.
+ 
+ You should have received a copy of the GNU Lesser General Public
+ License along with this library; if not, write to the Free Software
+ Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
+ */
+
+#ifndef Character_h
+#define Character_h
+
+#include <ctype.h>
+
+// WCharacter.h prototypes
+inline boolean isAlphaNumeric(int c) __attribute__((always_inline));
+inline boolean isAlpha(int c) __attribute__((always_inline));
+inline boolean isAscii(int c) __attribute__((always_inline));
+inline boolean isWhitespace(int c) __attribute__((always_inline));
+inline boolean isControl(int c) __attribute__((always_inline));
+inline boolean isDigit(int c) __attribute__((always_inline));
+inline boolean isGraph(int c) __attribute__((always_inline));
+inline boolean isLowerCase(int c) __attribute__((always_inline));
+inline boolean isPrintable(int c) __attribute__((always_inline));
+inline boolean isPunct(int c) __attribute__((always_inline));
+inline boolean isSpace(int c) __attribute__((always_inline));
+inline boolean isUpperCase(int c) __attribute__((always_inline));
+inline boolean isHexadecimalDigit(int c) __attribute__((always_inline));
+inline int toAscii(int c) __attribute__((always_inline));
+inline int toLowerCase(int c) __attribute__((always_inline));
+inline int toUpperCase(int c)__attribute__((always_inline));
+
+
+// Checks for an alphanumeric character. 
+// It is equivalent to (isalpha(c) || isdigit(c)).
+inline boolean isAlphaNumeric(int c) 
+{
+  return ( isalnum(c) == 0 ? false : true);
+}
+
+
+// Checks for an alphabetic character. 
+// It is equivalent to (isupper(c) || islower(c)).
+inline boolean isAlpha(int c)
+{
+  return ( isalpha(c) == 0 ? false : true);
+}
+
+
+// Checks whether c is a 7-bit unsigned char value 
+// that fits into the ASCII character set.
+inline boolean isAscii(int c)
+{
+  return ( isascii (c) == 0 ? false : true);
+}
+
+
+// Checks for a blank character, that is, a space or a tab.
+inline boolean isWhitespace(int c)
+{
+  return ( isblank (c) == 0 ? false : true);
+}
+
+
+// Checks for a control character.
+inline boolean isControl(int c)
+{
+  return ( iscntrl (c) == 0 ? false : true);
+}
+
+
+// Checks for a digit (0 through 9).
+inline boolean isDigit(int c)
+{
+  return ( isdigit (c) == 0 ? false : true);
+}
+
+
+// Checks for any printable character except space.
+inline boolean isGraph(int c)
+{
+  return ( isgraph (c) == 0 ? false : true);
+}
+
+
+// Checks for a lower-case character.
+inline boolean isLowerCase(int c)
+{
+  return (islower (c) == 0 ? false : true);
+}
+
+
+// Checks for any printable character including space.
+inline boolean isPrintable(int c)
+{
+  return ( isprint (c) == 0 ? false : true);
+}
+
+
+// Checks for any printable character which is not a space 
+// or an alphanumeric character.
+inline boolean isPunct(int c)
+{
+  return ( ispunct (c) == 0 ? false : true);
+}
+
+
+// Checks for white-space characters. For the avr-libc library, 
+// these are: space, formfeed ('\f'), newline ('\n'), carriage 
+// return ('\r'), horizontal tab ('\t'), and vertical tab ('\v').
+inline boolean isSpace(int c)
+{
+  return ( isspace (c) == 0 ? false : true);
+}
+
+
+// Checks for an uppercase letter.
+inline boolean isUpperCase(int c)
+{
+  return ( isupper (c) == 0 ? false : true);
+}
+
+
+// Checks for a hexadecimal digits, i.e. one of 0 1 2 3 4 5 6 7 
+// 8 9 a b c d e f A B C D E F.
+inline boolean isHexadecimalDigit(int c)
+{
+  return ( isxdigit (c) == 0 ? false : true);
+}
+
+
+// Converts c to a 7-bit unsigned char value that fits into the 
+// ASCII character set, by clearing the high-order bits.
+inline int toAscii(int c)
+{
+  return toascii (c);
+}
+
+
+// Warning:
+// Many people will be unhappy if you use this function. 
+// This function will convert accented letters into random 
+// characters.
+
+// Converts the letter c to lower case, if possible.
+inline int toLowerCase(int c)
+{
+  return tolower (c);
+}
+
+
+// Converts the letter c to upper case, if possible.
+inline int toUpperCase(int c)
+{
+  return toupper (c);
+}
+
+#endif

cores/arduino/WInterrupts.c

@@ -0,0 +1,379 @@
+/* -*- mode: jde; c-basic-offset: 2; indent-tabs-mode: nil -*- */
+
+/*
+  Part of the Wiring project - http://wiring.uniandes.edu.co
+
+  Copyright (c) 2004-05 Hernando Barragan
+
+  This library is free software; you can redistribute it and/or
+  modify it under the terms of the GNU Lesser General Public
+  License as published by the Free Software Foundation; either
+  version 2.1 of the License, or (at your option) any later version.
+
+  This library 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
+  Lesser General Public License for more details.
+
+  You should have received a copy of the GNU Lesser General
+  Public License along with this library; if not, write to the
+  Free Software Foundation, Inc., 59 Temple Place, Suite 330,
+  Boston, MA  02111-1307  USA
+  
+  Modified 24 November 2006 by David A. Mellis
+  Modified 1 August 2010 by Mark Sproul
+*/
+
+#include <inttypes.h>
+#include <avr/io.h>
+#include <avr/interrupt.h>
+#include <avr/pgmspace.h>
+#include <stdio.h>
+
+#include "wiring_private.h"
+
+static void nothing(void) {
+}
+
+static volatile voidFuncPtr intFunc[EXTERNAL_NUM_INTERRUPTS] = {
+#if EXTERNAL_NUM_INTERRUPTS > 8
+    #warning There are more than 8 external interrupts. Some callbacks may not be initialized.
+    nothing,
+#endif
+#if EXTERNAL_NUM_INTERRUPTS > 7
+    nothing,
+#endif
+#if EXTERNAL_NUM_INTERRUPTS > 6
+    nothing,
+#endif
+#if EXTERNAL_NUM_INTERRUPTS > 5
+    nothing,
+#endif
+#if EXTERNAL_NUM_INTERRUPTS > 4
+    nothing,
+#endif
+#if EXTERNAL_NUM_INTERRUPTS > 3
+    nothing,
+#endif
+#if EXTERNAL_NUM_INTERRUPTS > 2
+    nothing,
+#endif
+#if EXTERNAL_NUM_INTERRUPTS > 1
+    nothing,
+#endif
+#if EXTERNAL_NUM_INTERRUPTS > 0
+    nothing,
+#endif
+};
+
+void attachInterrupt(uint8_t interruptNum, void (*userFunc)(void), int mode) {
+  if(interruptNum < EXTERNAL_NUM_INTERRUPTS) {
+    intFunc[interruptNum] = userFunc;
+    
+    // Configure the interrupt mode (trigger on low input, any change, rising
+    // edge, or falling edge).  The mode constants were chosen to correspond
+    // to the configuration bits in the hardware register, so we simply shift
+    // the mode into place.
+      
+    // Enable the interrupt.
+      
+    switch (interruptNum) {
+#if defined(__AVR_ATmega32U4__)
+	// I hate doing this, but the register assignment differs between the 1280/2560
+	// and the 32U4.  Since avrlib defines registers PCMSK1 and PCMSK2 that aren't 
+	// even present on the 32U4 this is the only way to distinguish between them.
+    case 0:
+	EICRA = (EICRA & ~((1<<ISC00) | (1<<ISC01))) | (mode << ISC00);
+	EIMSK |= (1<<INT0);
+	break;
+    case 1:
+	EICRA = (EICRA & ~((1<<ISC10) | (1<<ISC11))) | (mode << ISC10);
+	EIMSK |= (1<<INT1);
+	break;	
+    case 2:
+        EICRA = (EICRA & ~((1<<ISC20) | (1<<ISC21))) | (mode << ISC20);
+        EIMSK |= (1<<INT2);
+        break;
+    case 3:
+        EICRA = (EICRA & ~((1<<ISC30) | (1<<ISC31))) | (mode << ISC30);
+        EIMSK |= (1<<INT3);
+        break;
+    case 4:
+        EICRB = (EICRB & ~((1<<ISC60) | (1<<ISC61))) | (mode << ISC60);
+        EIMSK |= (1<<INT6);
+        break;
+#elif defined(__AVR_AT90USB82__) || defined(__AVR_AT90USB162__) || defined(__AVR_ATmega32U2__) || defined(__AVR_ATmega16U2__) || defined(__AVR_ATmega8U2__)
+    case 0:
+      EICRA = (EICRA & ~((1 << ISC00) | (1 << ISC01))) | (mode << ISC00);
+      EIMSK |= (1 << INT0);
+      break;
+    case 1:
+      EICRA = (EICRA & ~((1 << ISC10) | (1 << ISC11))) | (mode << ISC10);
+      EIMSK |= (1 << INT1);
+      break;
+    case 2:
+      EICRA = (EICRA & ~((1 << ISC20) | (1 << ISC21))) | (mode << ISC20);
+      EIMSK |= (1 << INT2);
+      break;
+    case 3:
+      EICRA = (EICRA & ~((1 << ISC30) | (1 << ISC31))) | (mode << ISC30);
+      EIMSK |= (1 << INT3);
+      break;
+    case 4:
+      EICRB = (EICRB & ~((1 << ISC40) | (1 << ISC41))) | (mode << ISC40);
+      EIMSK |= (1 << INT4);
+      break;
+    case 5:
+      EICRB = (EICRB & ~((1 << ISC50) | (1 << ISC51))) | (mode << ISC50);
+      EIMSK |= (1 << INT5);
+      break;
+    case 6:
+      EICRB = (EICRB & ~((1 << ISC60) | (1 << ISC61))) | (mode << ISC60);
+      EIMSK |= (1 << INT6);
+      break;
+    case 7:
+      EICRB = (EICRB & ~((1 << ISC70) | (1 << ISC71))) | (mode << ISC70);
+      EIMSK |= (1 << INT7);
+      break;
+#elif defined(EICRA) && defined(EICRB) && defined(EIMSK)
+    case 2:
+      EICRA = (EICRA & ~((1 << ISC00) | (1 << ISC01))) | (mode << ISC00);
+      EIMSK |= (1 << INT0);
+      break;
+    case 3:
+      EICRA = (EICRA & ~((1 << ISC10) | (1 << ISC11))) | (mode << ISC10);
+      EIMSK |= (1 << INT1);
+      break;
+    case 4:
+      EICRA = (EICRA & ~((1 << ISC20) | (1 << ISC21))) | (mode << ISC20);
+      EIMSK |= (1 << INT2);
+      break;
+    case 5:
+      EICRA = (EICRA & ~((1 << ISC30) | (1 << ISC31))) | (mode << ISC30);
+      EIMSK |= (1 << INT3);
+      break;
+    case 0:
+      EICRB = (EICRB & ~((1 << ISC40) | (1 << ISC41))) | (mode << ISC40);
+      EIMSK |= (1 << INT4);
+      break;
+    case 1:
+      EICRB = (EICRB & ~((1 << ISC50) | (1 << ISC51))) | (mode << ISC50);
+      EIMSK |= (1 << INT5);
+      break;
+    case 6:
+      EICRB = (EICRB & ~((1 << ISC60) | (1 << ISC61))) | (mode << ISC60);
+      EIMSK |= (1 << INT6);
+      break;
+    case 7:
+      EICRB = (EICRB & ~((1 << ISC70) | (1 << ISC71))) | (mode << ISC70);
+      EIMSK |= (1 << INT7);
+      break;
+#else		
+    case 0:
+    #if defined(EICRA) && defined(ISC00) && defined(EIMSK)
+      EICRA = (EICRA & ~((1 << ISC00) | (1 << ISC01))) | (mode << ISC00);
+      EIMSK |= (1 << INT0);
+    #elif defined(MCUCR) && defined(ISC00) && defined(GICR)
+      MCUCR = (MCUCR & ~((1 << ISC00) | (1 << ISC01))) | (mode << ISC00);
+      GICR |= (1 << INT0);
+    #elif defined(MCUCR) && defined(ISC00) && defined(GIMSK)
+      MCUCR = (MCUCR & ~((1 << ISC00) | (1 << ISC01))) | (mode << ISC00);
+      GIMSK |= (1 << INT0);
+    #else
+      #error attachInterrupt not finished for this CPU (case 0)
+    #endif
+      break;
+
+    case 1:
+    #if defined(EICRA) && defined(ISC10) && defined(ISC11) && defined(EIMSK)
+      EICRA = (EICRA & ~((1 << ISC10) | (1 << ISC11))) | (mode << ISC10);
+      EIMSK |= (1 << INT1);
+    #elif defined(MCUCR) && defined(ISC10) && defined(ISC11) && defined(GICR)
+      MCUCR = (MCUCR & ~((1 << ISC10) | (1 << ISC11))) | (mode << ISC10);
+      GICR |= (1 << INT1);
+    #elif defined(MCUCR) && defined(ISC10) && defined(GIMSK) && defined(GIMSK)
+      MCUCR = (MCUCR & ~((1 << ISC10) | (1 << ISC11))) | (mode << ISC10);
+      GIMSK |= (1 << INT1);
+    #else
+      #warning attachInterrupt may need some more work for this cpu (case 1)
+    #endif
+      break;
+    
+    case 2:
+    #if defined(EICRA) && defined(ISC20) && defined(ISC21) && defined(EIMSK)
+      EICRA = (EICRA & ~((1 << ISC20) | (1 << ISC21))) | (mode << ISC20);
+      EIMSK |= (1 << INT2);
+    #elif defined(MCUCR) && defined(ISC20) && defined(ISC21) && defined(GICR)
+      MCUCR = (MCUCR & ~((1 << ISC20) | (1 << ISC21))) | (mode << ISC20);
+      GICR |= (1 << INT2);
+    #elif defined(MCUCR) && defined(ISC20) && defined(GIMSK) && defined(GIMSK)
+      MCUCR = (MCUCR & ~((1 << ISC20) | (1 << ISC21))) | (mode << ISC20);
+      GIMSK |= (1 << INT2);
+    #endif
+      break;
+#endif
+    }
+  }
+}
+
+void detachInterrupt(uint8_t interruptNum) {
+  if(interruptNum < EXTERNAL_NUM_INTERRUPTS) {
+    // Disable the interrupt.  (We can't assume that interruptNum is equal
+    // to the number of the EIMSK bit to clear, as this isn't true on the 
+    // ATmega8.  There, INT0 is 6 and INT1 is 7.)
+    switch (interruptNum) {
+#if defined(__AVR_ATmega32U4__)
+    case 0:
+        EIMSK &= ~(1<<INT0);
+        break;
+    case 1:
+        EIMSK &= ~(1<<INT1);
+        break;
+    case 2:
+        EIMSK &= ~(1<<INT2);
+        break;
+    case 3:
+        EIMSK &= ~(1<<INT3);
+        break;	
+    case 4:
+        EIMSK &= ~(1<<INT6);
+        break;
+#elif defined(__AVR_AT90USB82__) || defined(__AVR_AT90USB162__) || defined(__AVR_ATmega32U2__) || defined(__AVR_ATmega16U2__) || defined(__AVR_ATmega8U2__)
+    case 0:
+      EIMSK &= ~(1 << INT0);
+      break;
+    case 1:
+      EIMSK &= ~(1 << INT1);
+      break;
+    case 2:
+      EIMSK &= ~(1 << INT2);
+      break;
+    case 3:
+      EIMSK &= ~(1 << INT3);
+      break;
+    case 4:
+      EIMSK &= ~(1 << INT4);
+      break;
+    case 5:
+      EIMSK &= ~(1 << INT5);
+      break;
+    case 6:
+      EIMSK &= ~(1 << INT6);
+      break;
+    case 7:
+      EIMSK &= ~(1 << INT7);
+      break;
+#elif defined(EICRA) && defined(EICRB) && defined(EIMSK)
+    case 2:
+      EIMSK &= ~(1 << INT0);
+      break;
+    case 3:
+      EIMSK &= ~(1 << INT1);
+      break;
+    case 4:
+      EIMSK &= ~(1 << INT2);
+      break;
+    case 5:
+      EIMSK &= ~(1 << INT3);
+      break;
+    case 0:
+      EIMSK &= ~(1 << INT4);
+      break;
+    case 1:
+      EIMSK &= ~(1 << INT5);
+      break;
+    case 6:
+      EIMSK &= ~(1 << INT6);
+      break;
+    case 7:
+      EIMSK &= ~(1 << INT7);
+      break;
+#else
+    case 0:
+    #if defined(EIMSK) && defined(INT0)
+      EIMSK &= ~(1 << INT0);
+    #elif defined(GICR) && defined(ISC00)
+      GICR &= ~(1 << INT0); // atmega32
+    #elif defined(GIMSK) && defined(INT0)
+      GIMSK &= ~(1 << INT0);
+    #else
+      #error detachInterrupt not finished for this cpu
+    #endif
+      break;
+
+    case 1:
+    #if defined(EIMSK) && defined(INT1)
+      EIMSK &= ~(1 << INT1);
+    #elif defined(GICR) && defined(INT1)
+      GICR &= ~(1 << INT1); // atmega32
+    #elif defined(GIMSK) && defined(INT1)
+      GIMSK &= ~(1 << INT1);
+    #else
+      #warning detachInterrupt may need some more work for this cpu (case 1)
+    #endif
+      break;
+      
+    case 2:
+    #if defined(EIMSK) && defined(INT2)
+      EIMSK &= ~(1 << INT2);
+    #elif defined(GICR) && defined(INT2)
+      GICR &= ~(1 << INT2); // atmega32
+    #elif defined(GIMSK) && defined(INT2)
+      GIMSK &= ~(1 << INT2);
+    #elif defined(INT2)
+      #warning detachInterrupt may need some more work for this cpu (case 2)
+    #endif
+      break;       
+#endif
+    }
+      
+    intFunc[interruptNum] = nothing;
+  }
+}
+
+
+#define IMPLEMENT_ISR(vect, interrupt) \
+  ISR(vect) { \
+    intFunc[interrupt](); \
+  }
+
+#if defined(__AVR_ATmega32U4__)
+
+IMPLEMENT_ISR(INT0_vect, EXTERNAL_INT_0)
+IMPLEMENT_ISR(INT1_vect, EXTERNAL_INT_1)
+IMPLEMENT_ISR(INT2_vect, EXTERNAL_INT_2)
+IMPLEMENT_ISR(INT3_vect, EXTERNAL_INT_3)
+IMPLEMENT_ISR(INT6_vect, EXTERNAL_INT_4)
+
+#elif defined(__AVR_AT90USB82__) || defined(__AVR_AT90USB162__) || defined(__AVR_ATmega32U2__) || defined(__AVR_ATmega16U2__) || defined(__AVR_ATmega8U2__)
+
+IMPLEMENT_ISR(INT0_vect, EXTERNAL_INT_0)
+IMPLEMENT_ISR(INT1_vect, EXTERNAL_INT_1)
+IMPLEMENT_ISR(INT2_vect, EXTERNAL_INT_2)
+IMPLEMENT_ISR(INT3_vect, EXTERNAL_INT_3)
+IMPLEMENT_ISR(INT4_vect, EXTERNAL_INT_4)
+IMPLEMENT_ISR(INT5_vect, EXTERNAL_INT_5)
+IMPLEMENT_ISR(INT6_vect, EXTERNAL_INT_6)
+IMPLEMENT_ISR(INT7_vect, EXTERNAL_INT_7)
+
+#elif defined(EICRA) && defined(EICRB)
+
+IMPLEMENT_ISR(INT0_vect, EXTERNAL_INT_2)
+IMPLEMENT_ISR(INT1_vect, EXTERNAL_INT_3)
+IMPLEMENT_ISR(INT2_vect, EXTERNAL_INT_4)
+IMPLEMENT_ISR(INT3_vect, EXTERNAL_INT_5)
+IMPLEMENT_ISR(INT4_vect, EXTERNAL_INT_0)
+IMPLEMENT_ISR(INT5_vect, EXTERNAL_INT_1)
+IMPLEMENT_ISR(INT6_vect, EXTERNAL_INT_6)
+IMPLEMENT_ISR(INT7_vect, EXTERNAL_INT_7)
+
+#else
+
+IMPLEMENT_ISR(INT0_vect, EXTERNAL_INT_0)
+IMPLEMENT_ISR(INT1_vect, EXTERNAL_INT_1)
+
+#if defined(EICRA) && defined(ISC20)
+IMPLEMENT_ISR(INT2_vect, EXTERNAL_INT_2)
+#endif
+
+#endif

cores/arduino/WMath.cpp

@@ -0,0 +1,58 @@
+/* -*- mode: jde; c-basic-offset: 2; indent-tabs-mode: nil -*- */
+
+/*
+  Part of the Wiring project - http://wiring.org.co
+  Copyright (c) 2004-06 Hernando Barragan
+  Modified 13 August 2006, David A. Mellis for Arduino - http://www.arduino.cc/
+  
+  This library is free software; you can redistribute it and/or
+  modify it under the terms of the GNU Lesser General Public
+  License as published by the Free Software Foundation; either
+  version 2.1 of the License, or (at your option) any later version.
+
+  This library 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
+  Lesser General Public License for more details.
+
+  You should have received a copy of the GNU Lesser General
+  Public License along with this library; if not, write to the
+  Free Software Foundation, Inc., 59 Temple Place, Suite 330,
+  Boston, MA  02111-1307  USA
+*/
+
+extern "C" {
+  #include "stdlib.h"
+}
+
+void randomSeed(unsigned long seed)
+{
+  if (seed != 0) {
+    srandom(seed);
+  }
+}
+
+long random(long howbig)
+{
+  if (howbig == 0) {
+    return 0;
+  }
+  return random() % howbig;
+}
+
+long random(long howsmall, long howbig)
+{
+  if (howsmall >= howbig) {
+    return howsmall;
+  }
+  long diff = howbig - howsmall;
+  return random(diff) + howsmall;
+}
+
+long map(long x, long in_min, long in_max, long out_min, long out_max)
+{
+  return (x - in_min) * (out_max - out_min) / (in_max - in_min) + out_min;
+}
+
+unsigned int makeWord(unsigned int w) { return w; }
+unsigned int makeWord(unsigned char h, unsigned char l) { return (h << 8) | l; }

cores/arduino/WString.cpp

@@ -0,0 +1,750 @@
+/*
+  WString.cpp - String library for Wiring & Arduino
+  ...mostly rewritten by Paul Stoffregen...
+  Copyright (c) 2009-10 Hernando Barragan.  All rights reserved.
+  Copyright 2011, Paul Stoffregen, paul@pjrc.com
+
+  This library is free software; you can redistribute it and/or
+  modify it under the terms of the GNU Lesser General Public
+  License as published by the Free Software Foundation; either
+  version 2.1 of the License, or (at your option) any later version.
+
+  This library 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
+  Lesser General Public License for more details.
+
+  You should have received a copy of the GNU Lesser General Public
+  License along with this library; if not, write to the Free Software
+  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
+*/
+
+#include "WString.h"
+
+/*********************************************/
+/*  Constructors                             */
+/*********************************************/
+
+String::String(const char *cstr)
+{
+	init();
+	if (cstr) copy(cstr, strlen(cstr));
+}
+
+String::String(const String &value)
+{
+	init();
+	*this = value;
+}
+
+String::String(const __FlashStringHelper *pstr)
+{
+	init();
+	*this = pstr;
+}
+
+#if __cplusplus >= 201103L || defined(__GXX_EXPERIMENTAL_CXX0X__)
+String::String(String &&rval)
+{
+	init();
+	move(rval);
+}
+String::String(StringSumHelper &&rval)
+{
+	init();
+	move(rval);
+}
+#endif
+
+String::String(char c)
+{
+	init();
+	char buf[2];
+	buf[0] = c;
+	buf[1] = 0;
+	*this = buf;
+}
+
+String::String(unsigned char value, unsigned char base)
+{
+	init();
+	char buf[1 + 8 * sizeof(unsigned char)];
+	utoa(value, buf, base);
+	*this = buf;
+}
+
+String::String(int value, unsigned char base)
+{
+	init();
+	char buf[2 + 8 * sizeof(int)];
+	itoa(value, buf, base);
+	*this = buf;
+}
+
+String::String(unsigned int value, unsigned char base)
+{
+	init();
+	char buf[1 + 8 * sizeof(unsigned int)];
+	utoa(value, buf, base);
+	*this = buf;
+}
+
+String::String(long value, unsigned char base)
+{
+	init();
+	char buf[2 + 8 * sizeof(long)];
+	ltoa(value, buf, base);
+	*this = buf;
+}
+
+String::String(unsigned long value, unsigned char base)
+{
+	init();
+	char buf[1 + 8 * sizeof(unsigned long)];
+	ultoa(value, buf, base);
+	*this = buf;
+}
+
+String::String(float value, unsigned char decimalPlaces)
+{
+	init();
+	char buf[33];
+	*this = dtostrf(value, (decimalPlaces + 2), decimalPlaces, buf);
+}
+
+String::String(double value, unsigned char decimalPlaces)
+{
+	init();
+	char buf[33];
+	*this = dtostrf(value, (decimalPlaces + 2), decimalPlaces, buf);
+}
+
+String::~String()
+{
+	if (buffer) free(buffer);
+}
+
+/*********************************************/
+/*  Memory Management                        */
+/*********************************************/
+
+inline void String::init(void)
+{
+	buffer = NULL;
+	capacity = 0;
+	len = 0;
+}
+
+void String::invalidate(void)
+{
+	if (buffer) free(buffer);
+	buffer = NULL;
+	capacity = len = 0;
+}
+
+unsigned char String::reserve(unsigned int size)
+{
+	if (buffer && capacity >= size) return 1;
+	if (changeBuffer(size)) {
+		if (len == 0) buffer[0] = 0;
+		return 1;
+	}
+	return 0;
+}
+
+unsigned char String::changeBuffer(unsigned int maxStrLen)
+{
+	char *newbuffer = (char *)realloc(buffer, maxStrLen + 1);
+	if (newbuffer) {
+		buffer = newbuffer;
+		capacity = maxStrLen;
+		return 1;
+	}
+	return 0;
+}
+
+/*********************************************/
+/*  Copy and Move                            */
+/*********************************************/
+
+String & String::copy(const char *cstr, unsigned int length)
+{
+	if (!reserve(length)) {
+		invalidate();
+		return *this;
+	}
+	len = length;
+	strcpy(buffer, cstr);
+	return *this;
+}
+
+String & String::copy(const __FlashStringHelper *pstr, unsigned int length)
+{
+	if (!reserve(length)) {
+		invalidate();
+		return *this;
+	}
+	len = length;
+	strcpy_P(buffer, (PGM_P)pstr);
+	return *this;
+}
+
+#if __cplusplus >= 201103L || defined(__GXX_EXPERIMENTAL_CXX0X__)
+void String::move(String &rhs)
+{
+	if (buffer) {
+		if (rhs && capacity >= rhs.len) {
+			strcpy(buffer, rhs.buffer);
+			len = rhs.len;
+			rhs.len = 0;
+			return;
+		} else {
+			free(buffer);
+		}
+	}
+	buffer = rhs.buffer;
+	capacity = rhs.capacity;
+	len = rhs.len;
+	rhs.buffer = NULL;
+	rhs.capacity = 0;
+	rhs.len = 0;
+}
+#endif
+
+String & String::operator = (const String &rhs)
+{
+	if (this == &rhs) return *this;
+	
+	if (rhs.buffer) copy(rhs.buffer, rhs.len);
+	else invalidate();
+	
+	return *this;
+}
+
+#if __cplusplus >= 201103L || defined(__GXX_EXPERIMENTAL_CXX0X__)
+String & String::operator = (String &&rval)
+{
+	if (this != &rval) move(rval);
+	return *this;
+}
+
+String & String::operator = (StringSumHelper &&rval)
+{
+	if (this != &rval) move(rval);
+	return *this;
+}
+#endif
+
+String & String::operator = (const char *cstr)
+{
+	if (cstr) copy(cstr, strlen(cstr));
+	else invalidate();
+	
+	return *this;
+}
+
+String & String::operator = (const __FlashStringHelper *pstr)
+{
+	if (pstr) copy(pstr, strlen_P((PGM_P)pstr));
+	else invalidate();
+
+	return *this;
+}
+
+/*********************************************/
+/*  concat                                   */
+/*********************************************/
+
+unsigned char String::concat(const String &s)
+{
+	return concat(s.buffer, s.len);
+}
+
+unsigned char String::concat(const char *cstr, unsigned int length)
+{
+	unsigned int newlen = len + length;
+	if (!cstr) return 0;
+	if (length == 0) return 1;
+	if (!reserve(newlen)) return 0;
+	strcpy(buffer + len, cstr);
+	len = newlen;
+	return 1;
+}
+
+unsigned char String::concat(const char *cstr)
+{
+	if (!cstr) return 0;
+	return concat(cstr, strlen(cstr));
+}
+
+unsigned char String::concat(char c)
+{
+	char buf[2];
+	buf[0] = c;
+	buf[1] = 0;
+	return concat(buf, 1);
+}
+
+unsigned char String::concat(unsigned char num)
+{
+	char buf[1 + 3 * sizeof(unsigned char)];
+	itoa(num, buf, 10);
+	return concat(buf, strlen(buf));
+}
+
+unsigned char String::concat(int num)
+{
+	char buf[2 + 3 * sizeof(int)];
+	itoa(num, buf, 10);
+	return concat(buf, strlen(buf));
+}
+
+unsigned char String::concat(unsigned int num)
+{
+	char buf[1 + 3 * sizeof(unsigned int)];
+	utoa(num, buf, 10);
+	return concat(buf, strlen(buf));
+}
+
+unsigned char String::concat(long num)
+{
+	char buf[2 + 3 * sizeof(long)];
+	ltoa(num, buf, 10);
+	return concat(buf, strlen(buf));
+}
+
+unsigned char String::concat(unsigned long num)
+{
+	char buf[1 + 3 * sizeof(unsigned long)];
+	ultoa(num, buf, 10);
+	return concat(buf, strlen(buf));
+}
+
+unsigned char String::concat(float num)
+{
+	char buf[20];
+	char* string = dtostrf(num, 4, 2, buf);
+	return concat(string, strlen(string));
+}
+
+unsigned char String::concat(double num)
+{
+	char buf[20];
+	char* string = dtostrf(num, 4, 2, buf);
+	return concat(string, strlen(string));
+}
+
+unsigned char String::concat(const __FlashStringHelper * str)
+{
+	if (!str) return 0;
+	int length = strlen_P((const char *) str);
+	if (length == 0) return 1;
+	unsigned int newlen = len + length;
+	if (!reserve(newlen)) return 0;
+	strcpy_P(buffer + len, (const char *) str);
+	len = newlen;
+	return 1;
+}
+
+/*********************************************/
+/*  Concatenate                              */
+/*********************************************/
+
+StringSumHelper & operator + (const StringSumHelper &lhs, const String &rhs)
+{
+	StringSumHelper &a = const_cast<StringSumHelper&>(lhs);
+	if (!a.concat(rhs.buffer, rhs.len)) a.invalidate();
+	return a;
+}
+
+StringSumHelper & operator + (const StringSumHelper &lhs, const char *cstr)
+{
+	StringSumHelper &a = const_cast<StringSumHelper&>(lhs);
+	if (!cstr || !a.concat(cstr, strlen(cstr))) a.invalidate();
+	return a;
+}
+
+StringSumHelper & operator + (const StringSumHelper &lhs, char c)
+{
+	StringSumHelper &a = const_cast<StringSumHelper&>(lhs);
+	if (!a.concat(c)) a.invalidate();
+	return a;
+}
+
+StringSumHelper & operator + (const StringSumHelper &lhs, unsigned char num)
+{
+	StringSumHelper &a = const_cast<StringSumHelper&>(lhs);
+	if (!a.concat(num)) a.invalidate();
+	return a;
+}
+
+StringSumHelper & operator + (const StringSumHelper &lhs, int num)
+{
+	StringSumHelper &a = const_cast<StringSumHelper&>(lhs);
+	if (!a.concat(num)) a.invalidate();
+	return a;
+}
+
+StringSumHelper & operator + (const StringSumHelper &lhs, unsigned int num)
+{
+	StringSumHelper &a = const_cast<StringSumHelper&>(lhs);
+	if (!a.concat(num)) a.invalidate();
+	return a;
+}
+
+StringSumHelper & operator + (const StringSumHelper &lhs, long num)
+{
+	StringSumHelper &a = const_cast<StringSumHelper&>(lhs);
+	if (!a.concat(num)) a.invalidate();
+	return a;
+}
+
+StringSumHelper & operator + (const StringSumHelper &lhs, unsigned long num)
+{
+	StringSumHelper &a = const_cast<StringSumHelper&>(lhs);
+	if (!a.concat(num)) a.invalidate();
+	return a;
+}
+
+StringSumHelper & operator + (const StringSumHelper &lhs, float num)
+{
+	StringSumHelper &a = const_cast<StringSumHelper&>(lhs);
+	if (!a.concat(num)) a.invalidate();
+	return a;
+}
+
+StringSumHelper & operator + (const StringSumHelper &lhs, double num)
+{
+	StringSumHelper &a = const_cast<StringSumHelper&>(lhs);
+	if (!a.concat(num)) a.invalidate();
+	return a;
+}
+
+StringSumHelper & operator + (const StringSumHelper &lhs, const __FlashStringHelper *rhs)
+{
+	StringSumHelper &a = const_cast<StringSumHelper&>(lhs);
+	if (!a.concat(rhs))	a.invalidate();
+	return a;
+}
+
+/*********************************************/
+/*  Comparison                               */
+/*********************************************/
+
+int String::compareTo(const String &s) const
+{
+	if (!buffer || !s.buffer) {
+		if (s.buffer && s.len > 0) return 0 - *(unsigned char *)s.buffer;
+		if (buffer && len > 0) return *(unsigned char *)buffer;
+		return 0;
+	}
+	return strcmp(buffer, s.buffer);
+}
+
+unsigned char String::equals(const String &s2) const
+{
+	return (len == s2.len && compareTo(s2) == 0);
+}
+
+unsigned char String::equals(const char *cstr) const
+{
+	if (len == 0) return (cstr == NULL || *cstr == 0);
+	if (cstr == NULL) return buffer[0] == 0;
+	return strcmp(buffer, cstr) == 0;
+}
+
+unsigned char String::operator<(const String &rhs) const
+{
+	return compareTo(rhs) < 0;
+}
+
+unsigned char String::operator>(const String &rhs) const
+{
+	return compareTo(rhs) > 0;
+}
+
+unsigned char String::operator<=(const String &rhs) const
+{
+	return compareTo(rhs) <= 0;
+}
+
+unsigned char String::operator>=(const String &rhs) const
+{
+	return compareTo(rhs) >= 0;
+}
+
+unsigned char String::equalsIgnoreCase( const String &s2 ) const
+{
+	if (this == &s2) return 1;
+	if (len != s2.len) return 0;
+	if (len == 0) return 1;
+	const char *p1 = buffer;
+	const char *p2 = s2.buffer;
+	while (*p1) {
+		if (tolower(*p1++) != tolower(*p2++)) return 0;
+	} 
+	return 1;
+}
+
+unsigned char String::startsWith( const String &s2 ) const
+{
+	if (len < s2.len) return 0;
+	return startsWith(s2, 0);
+}
+
+unsigned char String::startsWith( const String &s2, unsigned int offset ) const
+{
+	if (offset > len - s2.len || !buffer || !s2.buffer) return 0;
+	return strncmp( &buffer[offset], s2.buffer, s2.len ) == 0;
+}
+
+unsigned char String::endsWith( const String &s2 ) const
+{
+	if ( len < s2.len || !buffer || !s2.buffer) return 0;
+	return strcmp(&buffer[len - s2.len], s2.buffer) == 0;
+}
+
+/*********************************************/
+/*  Character Access                         */
+/*********************************************/
+
+char String::charAt(unsigned int loc) const
+{
+	return operator[](loc);
+}
+
+void String::setCharAt(unsigned int loc, char c) 
+{
+	if (loc < len) buffer[loc] = c;
+}
+
+char & String::operator[](unsigned int index)
+{
+	static char dummy_writable_char;
+	if (index >= len || !buffer) {
+		dummy_writable_char = 0;
+		return dummy_writable_char;
+	}
+	return buffer[index];
+}
+
+char String::operator[]( unsigned int index ) const
+{
+	if (index >= len || !buffer) return 0;
+	return buffer[index];
+}
+
+void String::getBytes(unsigned char *buf, unsigned int bufsize, unsigned int index) const
+{
+	if (!bufsize || !buf) return;
+	if (index >= len) {
+		buf[0] = 0;
+		return;
+	}
+	unsigned int n = bufsize - 1;
+	if (n > len - index) n = len - index;
+	strncpy((char *)buf, buffer + index, n);
+	buf[n] = 0;
+}
+
+/*********************************************/
+/*  Search                                   */
+/*********************************************/
+
+int String::indexOf(char c) const
+{
+	return indexOf(c, 0);
+}
+
+int String::indexOf( char ch, unsigned int fromIndex ) const
+{
+	if (fromIndex >= len) return -1;
+	const char* temp = strchr(buffer + fromIndex, ch);
+	if (temp == NULL) return -1;
+	return temp - buffer;
+}
+
+int String::indexOf(const String &s2) const
+{
+	return indexOf(s2, 0);
+}
+
+int String::indexOf(const String &s2, unsigned int fromIndex) const
+{
+	if (fromIndex >= len) return -1;
+	const char *found = strstr(buffer + fromIndex, s2.buffer);
+	if (found == NULL) return -1;
+	return found - buffer;
+}
+
+int String::lastIndexOf( char theChar ) const
+{
+	return lastIndexOf(theChar, len - 1);
+}
+
+int String::lastIndexOf(char ch, unsigned int fromIndex) const
+{
+	if (fromIndex >= len) return -1;
+	char tempchar = buffer[fromIndex + 1];
+	buffer[fromIndex + 1] = '\0';
+	char* temp = strrchr( buffer, ch );
+	buffer[fromIndex + 1] = tempchar;
+	if (temp == NULL) return -1;
+	return temp - buffer;
+}
+
+int String::lastIndexOf(const String &s2) const
+{
+	return lastIndexOf(s2, len - s2.len);
+}
+
+int String::lastIndexOf(const String &s2, unsigned int fromIndex) const
+{
+  	if (s2.len == 0 || len == 0 || s2.len > len) return -1;
+	if (fromIndex >= len) fromIndex = len - 1;
+	int found = -1;
+	for (char *p = buffer; p <= buffer + fromIndex; p++) {
+		p = strstr(p, s2.buffer);
+		if (!p) break;
+		if ((unsigned int)(p - buffer) <= fromIndex) found = p - buffer;
+	}
+	return found;
+}
+
+String String::substring(unsigned int left, unsigned int right) const
+{
+	if (left > right) {
+		unsigned int temp = right;
+		right = left;
+		left = temp;
+	}
+	String out;
+	if (left >= len) return out;
+	if (right > len) right = len;
+	char temp = buffer[right];  // save the replaced character
+	buffer[right] = '\0';	
+	out = buffer + left;  // pointer arithmetic
+	buffer[right] = temp;  //restore character
+	return out;
+}
+
+/*********************************************/
+/*  Modification                             */
+/*********************************************/
+
+void String::replace(char find, char replace)
+{
+	if (!buffer) return;
+	for (char *p = buffer; *p; p++) {
+		if (*p == find) *p = replace;
+	}
+}
+
+void String::replace(const String& find, const String& replace)
+{
+	if (len == 0 || find.len == 0) return;
+	int diff = replace.len - find.len;
+	char *readFrom = buffer;
+	char *foundAt;
+	if (diff == 0) {
+		while ((foundAt = strstr(readFrom, find.buffer)) != NULL) {
+			memcpy(foundAt, replace.buffer, replace.len);
+			readFrom = foundAt + replace.len;
+		}
+	} else if (diff < 0) {
+		char *writeTo = buffer;
+		while ((foundAt = strstr(readFrom, find.buffer)) != NULL) {
+			unsigned int n = foundAt - readFrom;
+			memcpy(writeTo, readFrom, n);
+			writeTo += n;
+			memcpy(writeTo, replace.buffer, replace.len);
+			writeTo += replace.len;
+			readFrom = foundAt + find.len;
+			len += diff;
+		}
+		strcpy(writeTo, readFrom);
+	} else {
+		unsigned int size = len; // compute size needed for result
+		while ((foundAt = strstr(readFrom, find.buffer)) != NULL) {
+			readFrom = foundAt + find.len;
+			size += diff;
+		}
+		if (size == len) return;
+		if (size > capacity && !changeBuffer(size)) return; // XXX: tell user!
+		int index = len - 1;
+		while (index >= 0 && (index = lastIndexOf(find, index)) >= 0) {
+			readFrom = buffer + index + find.len;
+			memmove(readFrom + diff, readFrom, len - (readFrom - buffer));
+			len += diff;
+			buffer[len] = 0;
+			memcpy(buffer + index, replace.buffer, replace.len);
+			index--;
+		}
+	}
+}
+
+void String::remove(unsigned int index){
+	// Pass the biggest integer as the count. The remove method
+	// below will take care of truncating it at the end of the
+	// string.
+	remove(index, (unsigned int)-1);
+}
+
+void String::remove(unsigned int index, unsigned int count){
+	if (index >= len) { return; }
+	if (count <= 0) { return; }
+	if (count > len - index) { count = len - index; }
+	char *writeTo = buffer + index;
+	len = len - count;
+	strncpy(writeTo, buffer + index + count,len - index);
+	buffer[len] = 0;
+}
+
+void String::toLowerCase(void)
+{
+	if (!buffer) return;
+	for (char *p = buffer; *p; p++) {
+		*p = tolower(*p);
+	}
+}
+
+void String::toUpperCase(void)
+{
+	if (!buffer) return;
+	for (char *p = buffer; *p; p++) {
+		*p = toupper(*p);
+	}
+}
+
+void String::trim(void)
+{
+	if (!buffer || len == 0) return;
+	char *begin = buffer;
+	while (isspace(*begin)) begin++;
+	char *end = buffer + len - 1;
+	while (isspace(*end) && end >= begin) end--;
+	len = end + 1 - begin;
+	if (begin > buffer) memcpy(buffer, begin, len);
+	buffer[len] = 0;
+}
+
+/*********************************************/
+/*  Parsing / Conversion                     */
+/*********************************************/
+
+long String::toInt(void) const
+{
+	if (buffer) return atol(buffer);
+	return 0;
+}
+
+float String::toFloat(void) const
+{
+	return float(toDouble());
+}
+
+double String::toDouble(void) const
+{
+	if (buffer) return atof(buffer);
+	return 0;
+}

cores/arduino/WString.h

@@ -0,0 +1,229 @@
+/*
+  WString.h - String library for Wiring & Arduino
+  ...mostly rewritten by Paul Stoffregen...
+  Copyright (c) 2009-10 Hernando Barragan.  All right reserved.
+  Copyright 2011, Paul Stoffregen, paul@pjrc.com
+
+  This library is free software; you can redistribute it and/or
+  modify it under the terms of the GNU Lesser General Public
+  License as published by the Free Software Foundation; either
+  version 2.1 of the License, or (at your option) any later version.
+
+  This library 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
+  Lesser General Public License for more details.
+
+  You should have received a copy of the GNU Lesser General Public
+  License along with this library; if not, write to the Free Software
+  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
+*/
+
+#ifndef String_class_h
+#define String_class_h
+#ifdef __cplusplus
+
+#include <stdlib.h>
+#include <string.h>
+#include <ctype.h>
+#include <avr/pgmspace.h>
+
+// When compiling programs with this class, the following gcc parameters
+// dramatically increase performance and memory (RAM) efficiency, typically
+// with little or no increase in code size.
+//     -felide-constructors
+//     -std=c++0x
+
+class __FlashStringHelper;
+#define F(string_literal) (reinterpret_cast<const __FlashStringHelper *>(PSTR(string_literal)))
+
+// An inherited class for holding the result of a concatenation.  These
+// result objects are assumed to be writable by subsequent concatenations.
+class StringSumHelper;
+
+// The string class
+class String
+{
+	// use a function pointer to allow for "if (s)" without the
+	// complications of an operator bool(). for more information, see:
+	// http://www.artima.com/cppsource/safebool.html
+	typedef void (String::*StringIfHelperType)() const;
+	void StringIfHelper() const {}
+
+public:
+	// constructors
+	// creates a copy of the initial value.
+	// if the initial value is null or invalid, or if memory allocation
+	// fails, the string will be marked as invalid (i.e. "if (s)" will
+	// be false).
+	String(const char *cstr = "");
+	String(const String &str);
+	String(const __FlashStringHelper *str);
+       #if __cplusplus >= 201103L || defined(__GXX_EXPERIMENTAL_CXX0X__)
+	String(String &&rval);
+	String(StringSumHelper &&rval);
+	#endif
+	explicit String(char c);
+	explicit String(unsigned char, unsigned char base=10);
+	explicit String(int, unsigned char base=10);
+	explicit String(unsigned int, unsigned char base=10);
+	explicit String(long, unsigned char base=10);
+	explicit String(unsigned long, unsigned char base=10);
+	explicit String(float, unsigned char decimalPlaces=2);
+	explicit String(double, unsigned char decimalPlaces=2);
+	~String(void);
+
+	// memory management
+	// return true on success, false on failure (in which case, the string
+	// is left unchanged).  reserve(0), if successful, will validate an
+	// invalid string (i.e., "if (s)" will be true afterwards)
+	unsigned char reserve(unsigned int size);
+	inline unsigned int length(void) const {return len;}
+
+	// creates a copy of the assigned value.  if the value is null or
+	// invalid, or if the memory allocation fails, the string will be
+	// marked as invalid ("if (s)" will be false).
+	String & operator = (const String &rhs);
+	String & operator = (const char *cstr);
+	String & operator = (const __FlashStringHelper *str);
+       #if __cplusplus >= 201103L || defined(__GXX_EXPERIMENTAL_CXX0X__)
+	String & operator = (String &&rval);
+	String & operator = (StringSumHelper &&rval);
+	#endif
+
+	// concatenate (works w/ built-in types)
+
+	// returns true on success, false on failure (in which case, the string
+	// is left unchanged).  if the argument is null or invalid, the
+	// concatenation is considered unsuccessful.
+	unsigned char concat(const String &str);
+	unsigned char concat(const char *cstr);
+	unsigned char concat(char c);
+	unsigned char concat(unsigned char c);
+	unsigned char concat(int num);
+	unsigned char concat(unsigned int num);
+	unsigned char concat(long num);
+	unsigned char concat(unsigned long num);
+	unsigned char concat(float num);
+	unsigned char concat(double num);
+	unsigned char concat(const __FlashStringHelper * str);
+
+	// if there's not enough memory for the concatenated value, the string
+	// will be left unchanged (but this isn't signalled in any way)
+	String & operator += (const String &rhs)	{concat(rhs); return (*this);}
+	String & operator += (const char *cstr)		{concat(cstr); return (*this);}
+	String & operator += (char c)			{concat(c); return (*this);}
+	String & operator += (unsigned char num)		{concat(num); return (*this);}
+	String & operator += (int num)			{concat(num); return (*this);}
+	String & operator += (unsigned int num)		{concat(num); return (*this);}
+	String & operator += (long num)			{concat(num); return (*this);}
+	String & operator += (unsigned long num)	{concat(num); return (*this);}
+	String & operator += (float num)		{concat(num); return (*this);}
+	String & operator += (double num)		{concat(num); return (*this);}
+	String & operator += (const __FlashStringHelper *str){concat(str); return (*this);}
+
+	friend StringSumHelper & operator + (const StringSumHelper &lhs, const String &rhs);
+	friend StringSumHelper & operator + (const StringSumHelper &lhs, const char *cstr);
+	friend StringSumHelper & operator + (const StringSumHelper &lhs, char c);
+	friend StringSumHelper & operator + (const StringSumHelper &lhs, unsigned char num);
+	friend StringSumHelper & operator + (const StringSumHelper &lhs, int num);
+	friend StringSumHelper & operator + (const StringSumHelper &lhs, unsigned int num);
+	friend StringSumHelper & operator + (const StringSumHelper &lhs, long num);
+	friend StringSumHelper & operator + (const StringSumHelper &lhs, unsigned long num);
+	friend StringSumHelper & operator + (const StringSumHelper &lhs, float num);
+	friend StringSumHelper & operator + (const StringSumHelper &lhs, double num);
+	friend StringSumHelper & operator + (const StringSumHelper &lhs, const __FlashStringHelper *rhs);
+
+	// comparison (only works w/ Strings and "strings")
+	operator StringIfHelperType() const { return buffer ? &String::StringIfHelper : 0; }
+	int compareTo(const String &s) const;
+	unsigned char equals(const String &s) const;
+	unsigned char equals(const char *cstr) const;
+	unsigned char operator == (const String &rhs) const {return equals(rhs);}
+	unsigned char operator == (const char *cstr) const {return equals(cstr);}
+	unsigned char operator != (const String &rhs) const {return !equals(rhs);}
+	unsigned char operator != (const char *cstr) const {return !equals(cstr);}
+	unsigned char operator <  (const String &rhs) const;
+	unsigned char operator >  (const String &rhs) const;
+	unsigned char operator <= (const String &rhs) const;
+	unsigned char operator >= (const String &rhs) const;
+	unsigned char equalsIgnoreCase(const String &s) const;
+	unsigned char startsWith( const String &prefix) const;
+	unsigned char startsWith(const String &prefix, unsigned int offset) const;
+	unsigned char endsWith(const String &suffix) const;
+
+	// character access
+	char charAt(unsigned int index) const;
+	void setCharAt(unsigned int index, char c);
+	char operator [] (unsigned int index) const;
+	char& operator [] (unsigned int index);
+	void getBytes(unsigned char *buf, unsigned int bufsize, unsigned int index=0) const;
+	void toCharArray(char *buf, unsigned int bufsize, unsigned int index=0) const
+		{ getBytes((unsigned char *)buf, bufsize, index); }
+	const char* c_str() const { return buffer; }
+	char* begin() { return buffer; }
+	char* end() { return buffer + length(); }
+	const char* begin() const { return c_str(); }
+	const char* end() const { return c_str() + length(); }
+
+	// search
+	int indexOf( char ch ) const;
+	int indexOf( char ch, unsigned int fromIndex ) const;
+	int indexOf( const String &str ) const;
+	int indexOf( const String &str, unsigned int fromIndex ) const;
+	int lastIndexOf( char ch ) const;
+	int lastIndexOf( char ch, unsigned int fromIndex ) const;
+	int lastIndexOf( const String &str ) const;
+	int lastIndexOf( const String &str, unsigned int fromIndex ) const;
+	String substring( unsigned int beginIndex ) const { return substring(beginIndex, len); };
+	String substring( unsigned int beginIndex, unsigned int endIndex ) const;
+
+	// modification
+	void replace(char find, char replace);
+	void replace(const String& find, const String& replace);
+	void remove(unsigned int index);
+	void remove(unsigned int index, unsigned int count);
+	void toLowerCase(void);
+	void toUpperCase(void);
+	void trim(void);
+
+	// parsing/conversion
+	long toInt(void) const;
+	float toFloat(void) const;
+	double toDouble(void) const;
+
+protected:
+	char *buffer;	        // the actual char array
+	unsigned int capacity;  // the array length minus one (for the '\0')
+	unsigned int len;       // the String length (not counting the '\0')
+protected:
+	void init(void);
+	void invalidate(void);
+	unsigned char changeBuffer(unsigned int maxStrLen);
+	unsigned char concat(const char *cstr, unsigned int length);
+
+	// copy and move
+	String & copy(const char *cstr, unsigned int length);
+	String & copy(const __FlashStringHelper *pstr, unsigned int length);
+       #if __cplusplus >= 201103L || defined(__GXX_EXPERIMENTAL_CXX0X__)
+	void move(String &rhs);
+	#endif
+};
+
+class StringSumHelper : public String
+{
+public:
+	StringSumHelper(const String &s) : String(s) {}
+	StringSumHelper(const char *p) : String(p) {}
+	StringSumHelper(char c) : String(c) {}
+	StringSumHelper(unsigned char num) : String(num) {}
+	StringSumHelper(int num) : String(num) {}
+	StringSumHelper(unsigned int num) : String(num) {}
+	StringSumHelper(long num) : String(num) {}
+	StringSumHelper(unsigned long num) : String(num) {}
+	StringSumHelper(float num) : String(num) {}
+	StringSumHelper(double num) : String(num) {}
+};
+
+#endif  // __cplusplus
+#endif  // String_class_h

cores/arduino/abi.cpp

@@ -0,0 +1,36 @@
+/*
+  Copyright (c) 2014 Arduino.  All right reserved.
+
+  This library is free software; you can redistribute it and/or
+  modify it under the terms of the GNU Lesser General Public
+  License as published by the Free Software Foundation; either
+  version 2.1 of the License, or (at your option) any later version.
+
+  This library 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 Lesser General Public License for more details.
+
+  You should have received a copy of the GNU Lesser General Public
+  License along with this library; if not, write to the Free Software
+  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
+*/
+
+#include <stdlib.h>
+
+extern "C" void __cxa_pure_virtual(void) __attribute__ ((__noreturn__));
+extern "C" void __cxa_deleted_virtual(void) __attribute__ ((__noreturn__));
+
+namespace std {
+  [[gnu::weak, noreturn]] void terminate() {
+    abort();
+  }
+}
+
+void __cxa_pure_virtual(void) {
+  std::terminate();
+}
+
+void __cxa_deleted_virtual(void) {
+  std::terminate();
+}

cores/arduino/binary.h

@@ -0,0 +1,534 @@
+/*
+  binary.h - Definitions for binary constants
+  Copyright (c) 2006 David A. Mellis.  All right reserved.
+
+  This library is free software; you can redistribute it and/or
+  modify it under the terms of the GNU Lesser General Public
+  License as published by the Free Software Foundation; either
+  version 2.1 of the License, or (at your option) any later version.
+
+  This library 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
+  Lesser General Public License for more details.
+
+  You should have received a copy of the GNU Lesser General Public
+  License along with this library; if not, write to the Free Software
+  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
+*/
+
+#ifndef Binary_h
+#define Binary_h
+
+#define B0 0
+#define B00 0
+#define B000 0
+#define B0000 0
+#define B00000 0
+#define B000000 0
+#define B0000000 0
+#define B00000000 0
+#define B1 1
+#define B01 1
+#define B001 1
+#define B0001 1
+#define B00001 1
+#define B000001 1
+#define B0000001 1
+#define B00000001 1
+#define B10 2
+#define B010 2
+#define B0010 2
+#define B00010 2
+#define B000010 2
+#define B0000010 2
+#define B00000010 2
+#define B11 3
+#define B011 3
+#define B0011 3
+#define B00011 3
+#define B000011 3
+#define B0000011 3
+#define B00000011 3
+#define B100 4
+#define B0100 4
+#define B00100 4
+#define B000100 4
+#define B0000100 4
+#define B00000100 4
+#define B101 5
+#define B0101 5
+#define B00101 5
+#define B000101 5
+#define B0000101 5
+#define B00000101 5
+#define B110 6
+#define B0110 6
+#define B00110 6
+#define B000110 6
+#define B0000110 6
+#define B00000110 6
+#define B111 7
+#define B0111 7
+#define B00111 7
+#define B000111 7
+#define B0000111 7
+#define B00000111 7
+#define B1000 8
+#define B01000 8
+#define B001000 8
+#define B0001000 8
+#define B00001000 8
+#define B1001 9
+#define B01001 9
+#define B001001 9
+#define B0001001 9
+#define B00001001 9
+#define B1010 10
+#define B01010 10
+#define B001010 10
+#define B0001010 10
+#define B00001010 10
+#define B1011 11
+#define B01011 11
+#define B001011 11
+#define B0001011 11
+#define B00001011 11
+#define B1100 12
+#define B01100 12
+#define B001100 12
+#define B0001100 12
+#define B00001100 12
+#define B1101 13
+#define B01101 13
+#define B001101 13
+#define B0001101 13
+#define B00001101 13
+#define B1110 14
+#define B01110 14
+#define B001110 14
+#define B0001110 14
+#define B00001110 14
+#define B1111 15
+#define B01111 15
+#define B001111 15
+#define B0001111 15
+#define B00001111 15
+#define B10000 16
+#define B010000 16
+#define B0010000 16
+#define B00010000 16
+#define B10001 17
+#define B010001 17
+#define B0010001 17
+#define B00010001 17
+#define B10010 18
+#define B010010 18
+#define B0010010 18
+#define B00010010 18
+#define B10011 19
+#define B010011 19
+#define B0010011 19
+#define B00010011 19
+#define B10100 20
+#define B010100 20
+#define B0010100 20
+#define B00010100 20
+#define B10101 21
+#define B010101 21
+#define B0010101 21
+#define B00010101 21
+#define B10110 22
+#define B010110 22
+#define B0010110 22
+#define B00010110 22
+#define B10111 23
+#define B010111 23
+#define B0010111 23
+#define B00010111 23
+#define B11000 24
+#define B011000 24
+#define B0011000 24
+#define B00011000 24
+#define B11001 25
+#define B011001 25
+#define B0011001 25
+#define B00011001 25
+#define B11010 26
+#define B011010 26
+#define B0011010 26
+#define B00011010 26
+#define B11011 27
+#define B011011 27
+#define B0011011 27
+#define B00011011 27
+#define B11100 28
+#define B011100 28
+#define B0011100 28
+#define B00011100 28
+#define B11101 29
+#define B011101 29
+#define B0011101 29
+#define B00011101 29
+#define B11110 30
+#define B011110 30
+#define B0011110 30
+#define B00011110 30
+#define B11111 31
+#define B011111 31
+#define B0011111 31
+#define B00011111 31
+#define B100000 32
+#define B0100000 32
+#define B00100000 32
+#define B100001 33
+#define B0100001 33
+#define B00100001 33
+#define B100010 34
+#define B0100010 34
+#define B00100010 34
+#define B100011 35
+#define B0100011 35
+#define B00100011 35
+#define B100100 36
+#define B0100100 36
+#define B00100100 36
+#define B100101 37
+#define B0100101 37
+#define B00100101 37
+#define B100110 38
+#define B0100110 38
+#define B00100110 38
+#define B100111 39
+#define B0100111 39
+#define B00100111 39
+#define B101000 40
+#define B0101000 40
+#define B00101000 40
+#define B101001 41
+#define B0101001 41
+#define B00101001 41
+#define B101010 42
+#define B0101010 42
+#define B00101010 42
+#define B101011 43
+#define B0101011 43
+#define B00101011 43
+#define B101100 44
+#define B0101100 44
+#define B00101100 44
+#define B101101 45
+#define B0101101 45
+#define B00101101 45
+#define B101110 46
+#define B0101110 46
+#define B00101110 46
+#define B101111 47
+#define B0101111 47
+#define B00101111 47
+#define B110000 48
+#define B0110000 48
+#define B00110000 48
+#define B110001 49
+#define B0110001 49
+#define B00110001 49
+#define B110010 50
+#define B0110010 50
+#define B00110010 50
+#define B110011 51
+#define B0110011 51
+#define B00110011 51
+#define B110100 52
+#define B0110100 52
+#define B00110100 52
+#define B110101 53
+#define B0110101 53
+#define B00110101 53
+#define B110110 54
+#define B0110110 54
+#define B00110110 54
+#define B110111 55
+#define B0110111 55
+#define B00110111 55
+#define B111000 56
+#define B0111000 56
+#define B00111000 56
+#define B111001 57
+#define B0111001 57
+#define B00111001 57
+#define B111010 58
+#define B0111010 58
+#define B00111010 58
+#define B111011 59
+#define B0111011 59
+#define B00111011 59
+#define B111100 60
+#define B0111100 60
+#define B00111100 60
+#define B111101 61
+#define B0111101 61
+#define B00111101 61
+#define B111110 62
+#define B0111110 62
+#define B00111110 62
+#define B111111 63
+#define B0111111 63
+#define B00111111 63
+#define B1000000 64
+#define B01000000 64
+#define B1000001 65
+#define B01000001 65
+#define B1000010 66
+#define B01000010 66
+#define B1000011 67
+#define B01000011 67
+#define B1000100 68
+#define B01000100 68
+#define B1000101 69
+#define B01000101 69
+#define B1000110 70
+#define B01000110 70
+#define B1000111 71
+#define B01000111 71
+#define B1001000 72
+#define B01001000 72
+#define B1001001 73
+#define B01001001 73
+#define B1001010 74
+#define B01001010 74
+#define B1001011 75
+#define B01001011 75
+#define B1001100 76
+#define B01001100 76
+#define B1001101 77
+#define B01001101 77
+#define B1001110 78
+#define B01001110 78
+#define B1001111 79
+#define B01001111 79
+#define B1010000 80
+#define B01010000 80
+#define B1010001 81
+#define B01010001 81
+#define B1010010 82
+#define B01010010 82
+#define B1010011 83
+#define B01010011 83
+#define B1010100 84
+#define B01010100 84
+#define B1010101 85
+#define B01010101 85
+#define B1010110 86
+#define B01010110 86
+#define B1010111 87
+#define B01010111 87
+#define B1011000 88
+#define B01011000 88
+#define B1011001 89
+#define B01011001 89
+#define B1011010 90
+#define B01011010 90
+#define B1011011 91
+#define B01011011 91
+#define B1011100 92
+#define B01011100 92
+#define B1011101 93
+#define B01011101 93
+#define B1011110 94
+#define B01011110 94
+#define B1011111 95
+#define B01011111 95
+#define B1100000 96
+#define B01100000 96
+#define B1100001 97
+#define B01100001 97
+#define B1100010 98
+#define B01100010 98
+#define B1100011 99
+#define B01100011 99
+#define B1100100 100
+#define B01100100 100
+#define B1100101 101
+#define B01100101 101
+#define B1100110 102
+#define B01100110 102
+#define B1100111 103
+#define B01100111 103
+#define B1101000 104
+#define B01101000 104
+#define B1101001 105
+#define B01101001 105
+#define B1101010 106
+#define B01101010 106
+#define B1101011 107
+#define B01101011 107
+#define B1101100 108
+#define B01101100 108
+#define B1101101 109
+#define B01101101 109
+#define B1101110 110
+#define B01101110 110
+#define B1101111 111
+#define B01101111 111
+#define B1110000 112
+#define B01110000 112
+#define B1110001 113
+#define B01110001 113
+#define B1110010 114
+#define B01110010 114
+#define B1110011 115
+#define B01110011 115
+#define B1110100 116
+#define B01110100 116
+#define B1110101 117
+#define B01110101 117
+#define B1110110 118
+#define B01110110 118
+#define B1110111 119
+#define B01110111 119
+#define B1111000 120
+#define B01111000 120
+#define B1111001 121
+#define B01111001 121
+#define B1111010 122
+#define B01111010 122
+#define B1111011 123
+#define B01111011 123
+#define B1111100 124
+#define B01111100 124
+#define B1111101 125
+#define B01111101 125
+#define B1111110 126
+#define B01111110 126
+#define B1111111 127
+#define B01111111 127
+#define B10000000 128
+#define B10000001 129
+#define B10000010 130
+#define B10000011 131
+#define B10000100 132
+#define B10000101 133
+#define B10000110 134
+#define B10000111 135
+#define B10001000 136
+#define B10001001 137
+#define B10001010 138
+#define B10001011 139
+#define B10001100 140
+#define B10001101 141
+#define B10001110 142
+#define B10001111 143
+#define B10010000 144
+#define B10010001 145
+#define B10010010 146
+#define B10010011 147
+#define B10010100 148
+#define B10010101 149
+#define B10010110 150
+#define B10010111 151
+#define B10011000 152
+#define B10011001 153
+#define B10011010 154
+#define B10011011 155
+#define B10011100 156
+#define B10011101 157
+#define B10011110 158
+#define B10011111 159
+#define B10100000 160
+#define B10100001 161
+#define B10100010 162
+#define B10100011 163
+#define B10100100 164
+#define B10100101 165
+#define B10100110 166
+#define B10100111 167
+#define B10101000 168
+#define B10101001 169
+#define B10101010 170
+#define B10101011 171
+#define B10101100 172
+#define B10101101 173
+#define B10101110 174
+#define B10101111 175
+#define B10110000 176
+#define B10110001 177
+#define B10110010 178
+#define B10110011 179
+#define B10110100 180
+#define B10110101 181
+#define B10110110 182
+#define B10110111 183
+#define B10111000 184
+#define B10111001 185
+#define B10111010 186
+#define B10111011 187
+#define B10111100 188
+#define B10111101 189
+#define B10111110 190
+#define B10111111 191
+#define B11000000 192
+#define B11000001 193
+#define B11000010 194
+#define B11000011 195
+#define B11000100 196
+#define B11000101 197
+#define B11000110 198
+#define B11000111 199
+#define B11001000 200
+#define B11001001 201
+#define B11001010 202
+#define B11001011 203
+#define B11001100 204
+#define B11001101 205
+#define B11001110 206
+#define B11001111 207
+#define B11010000 208
+#define B11010001 209
+#define B11010010 210
+#define B11010011 211
+#define B11010100 212
+#define B11010101 213
+#define B11010110 214
+#define B11010111 215
+#define B11011000 216
+#define B11011001 217
+#define B11011010 218
+#define B11011011 219
+#define B11011100 220
+#define B11011101 221
+#define B11011110 222
+#define B11011111 223
+#define B11100000 224
+#define B11100001 225
+#define B11100010 226
+#define B11100011 227
+#define B11100100 228
+#define B11100101 229
+#define B11100110 230
+#define B11100111 231
+#define B11101000 232
+#define B11101001 233
+#define B11101010 234
+#define B11101011 235
+#define B11101100 236
+#define B11101101 237
+#define B11101110 238
+#define B11101111 239
+#define B11110000 240
+#define B11110001 241
+#define B11110010 242
+#define B11110011 243
+#define B11110100 244
+#define B11110101 245
+#define B11110110 246
+#define B11110111 247
+#define B11111000 248
+#define B11111001 249
+#define B11111010 250
+#define B11111011 251
+#define B11111100 252
+#define B11111101 253
+#define B11111110 254
+#define B11111111 255
+
+#endif

cores/arduino/hooks.c

@@ -0,0 +1,31 @@
+/*
+  Copyright (c) 2012 Arduino.  All right reserved.
+
+  This library is free software; you can redistribute it and/or
+  modify it under the terms of the GNU Lesser General Public
+  License as published by the Free Software Foundation; either
+  version 2.1 of the License, or (at your option) any later version.
+
+  This library 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 Lesser General Public License for more details.
+
+  You should have received a copy of the GNU Lesser General Public
+  License along with this library; if not, write to the Free Software
+  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
+*/
+
+/**
+ * Empty yield() hook.
+ *
+ * This function is intended to be used by library writers to build
+ * libraries or sketches that supports cooperative threads.
+ *
+ * Its defined as a weak symbol and it can be redefined to implement a
+ * real cooperative scheduler.
+ */
+static void __empty() {
+	// Empty
+}
+void yield(void) __attribute__ ((weak, alias("__empty")));

cores/arduino/main.cpp

@@ -0,0 +1,52 @@
+/*
+  main.cpp - Main loop for Arduino sketches
+  Copyright (c) 2005-2013 Arduino Team.  All right reserved.
+
+  This library is free software; you can redistribute it and/or
+  modify it under the terms of the GNU Lesser General Public
+  License as published by the Free Software Foundation; either
+  version 2.1 of the License, or (at your option) any later version.
+
+  This library 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
+  Lesser General Public License for more details.
+
+  You should have received a copy of the GNU Lesser General Public
+  License along with this library; if not, write to the Free Software
+  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
+*/
+
+#include <Arduino.h>
+
+// Declared weak in Arduino.h to allow user redefinitions.
+int atexit(void (* /*func*/ )()) { return 0; }
+
+// Weak empty variant initialization function.
+// May be redefined by variant files.
+void initVariant() __attribute__((weak));
+void initVariant() { }
+
+void setupUSB() __attribute__((weak));
+void setupUSB() { }
+
+int main(void)
+{
+	init();
+
+	initVariant();
+
+#if defined(USBCON)
+	USBDevice.attach();
+#endif
+	
+	setup();
+    
+	for (;;) {
+		loop();
+		if (serialEventRun) serialEventRun();
+	}
+        
+	return 0;
+}
+

cores/arduino/new

@@ -0,0 +1,66 @@
+/*
+  Copyright (c) 2014 Arduino.  All right reserved.
+
+  This library is free software; you can redistribute it and/or
+  modify it under the terms of the GNU Lesser General Public
+  License as published by the Free Software Foundation; either
+  version 2.1 of the License, or (at your option) any later version.
+
+  This library 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 Lesser General Public License for more details.
+
+  You should have received a copy of the GNU Lesser General Public
+  License along with this library; if not, write to the Free Software
+  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
+*/
+
+#ifndef NEW_H
+#define NEW_H
+
+#include <stdlib.h>
+
+namespace std {
+  struct nothrow_t {};
+  extern const nothrow_t nothrow;
+
+  // These are not actually implemented, to prevent overhead and
+  // complexity. They are still declared to allow implementing
+  // them in user code if needed.
+  typedef void (*new_handler)();
+  new_handler set_new_handler(new_handler new_p) noexcept;
+  new_handler get_new_handler() noexcept;
+
+  // This is normally declared in various headers that we do not have
+  // available, so just define it here. We could also use ::size_t
+  // below, but then anyone including <new> can no longer assume
+  // std::size_t is available.
+  using size_t = ::size_t;
+} // namespace std
+
+[[gnu::weak]] void * operator new(std::size_t size);
+[[gnu::weak]] void * operator new[](std::size_t size);
+
+[[gnu::weak]] void * operator new(std::size_t size, const std::nothrow_t tag) noexcept;
+[[gnu::weak]] void * operator new[](std::size_t size, const std::nothrow_t& tag) noexcept;
+
+void * operator new(std::size_t size, void *place) noexcept;
+void * operator new[](std::size_t size, void *place) noexcept;
+
+[[gnu::weak]] void operator delete(void * ptr) noexcept;
+[[gnu::weak]] void operator delete[](void * ptr) noexcept;
+
+#if __cplusplus >= 201402L
+[[gnu::weak]] void operator delete(void* ptr, std::size_t size) noexcept;
+[[gnu::weak]] void operator delete[](void * ptr, std::size_t size) noexcept;
+#endif // __cplusplus >= 201402L
+
+[[gnu::weak]] void operator delete(void* ptr, const std::nothrow_t& tag) noexcept;
+[[gnu::weak]] void operator delete[](void* ptr, const std::nothrow_t& tag) noexcept;
+
+void operator delete(void* ptr, void* place) noexcept;
+void operator delete[](void* ptr, void* place) noexcept;
+
+#endif
+

cores/arduino/new.cpp

@@ -0,0 +1,117 @@
+/*
+  Copyright (c) 2014 Arduino.  All right reserved.
+
+  This library is free software; you can redistribute it and/or
+  modify it under the terms of the GNU Lesser General Public
+  License as published by the Free Software Foundation; either
+  version 2.1 of the License, or (at your option) any later version.
+
+  This library 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 Lesser General Public License for more details.
+
+  You should have received a copy of the GNU Lesser General Public
+  License along with this library; if not, write to the Free Software
+  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
+*/
+
+#include "new.h"
+
+// The C++ spec dictates that allocation failure should cause the
+// (non-nothrow version of the) operator new to throw an exception.
+// Since we expect to have exceptions disabled, it would be more
+// appropriate (and probably standards-compliant) to terminate instead.
+// Historically failure causes null to be returned, but this define
+// allows switching to more robust terminating behaviour (that might
+// become the default at some point in the future). Note that any code
+// that wants null to be returned can (and should) use the nothrow
+// versions of the new statement anyway and is unaffected by this.
+// #define NEW_TERMINATES_ON_FAILURE
+
+namespace std {
+  // Defined in abi.cpp
+  void terminate();
+
+  const nothrow_t nothrow;
+}
+
+static void * new_helper(std::size_t size) {
+  // Even zero-sized allocations should return a unique pointer, but
+  // malloc does not guarantee this
+  if (size == 0)
+    size = 1;
+  return malloc(size);
+}
+
+void * operator new(std::size_t size) {
+  void *res = new_helper(size);
+#if defined(NEW_TERMINATES_ON_FAILURE)
+  if (!res)
+    std::terminate();
+#endif
+  return res;
+}
+void * operator new[](std::size_t size) {
+  return operator new(size);
+}
+
+void * operator new(std::size_t size, const std::nothrow_t tag) noexcept {
+#if defined(NEW_TERMINATES_ON_FAILURE)
+  // Cannot call throwing operator new as standard suggests, so call
+  // new_helper directly then
+  return new_helper(size);
+#else
+  return operator new(size);
+#endif
+}
+void * operator new[](std::size_t size, const std::nothrow_t& tag) noexcept {
+#if defined(NEW_TERMINATES_ON_FAILURE)
+  // Cannot call throwing operator new[] as standard suggests, so call
+  // malloc directly then
+  return new_helper(size);
+#else
+  return operator new[](size);
+#endif
+}
+
+void * operator new(std::size_t size, void *place) noexcept {
+  // Nothing to do
+  (void)size; // unused
+  return place;
+}
+void * operator new[](std::size_t size, void *place) noexcept {
+  return operator new(size, place);
+}
+
+void operator delete(void * ptr) noexcept {
+  free(ptr);
+}
+void operator delete[](void * ptr) noexcept {
+  operator delete(ptr);
+}
+
+#if __cplusplus >= 201402L
+void operator delete(void* ptr, std::size_t size) noexcept {
+  operator delete(ptr);
+}
+void operator delete[](void * ptr, std::size_t size) noexcept {
+  operator delete[](ptr);
+}
+#endif // __cplusplus >= 201402L
+
+void operator delete(void* ptr, const std::nothrow_t& tag) noexcept {
+  operator delete(ptr);
+}
+void operator delete[](void* ptr, const std::nothrow_t& tag) noexcept {
+  operator delete[](ptr);
+}
+
+void operator delete(void* ptr, void* place) noexcept {
+  (void)ptr; (void)place; // unused
+  // Nothing to do
+}
+void operator delete[](void* ptr, void* place) noexcept {
+  (void)ptr; (void)place; // unused
+  // Nothing to do
+}

cores/arduino/new.h

@@ -0,0 +1,3 @@
+// This file originally used a non-standard name for this Arduino core
+// only, so still expose the old new.h name for compatibility.
+#include "new"

cores/arduino/wiring.c

@@ -0,0 +1,392 @@
+/*
+  wiring.c - Partial implementation of the Wiring API for the ATmega8.
+  Part of Arduino - http://www.arduino.cc/
+
+  Copyright (c) 2005-2006 David A. Mellis
+
+  This library is free software; you can redistribute it and/or
+  modify it under the terms of the GNU Lesser General Public
+  License as published by the Free Software Foundation; either
+  version 2.1 of the License, or (at your option) any later version.
+
+  This library 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
+  Lesser General Public License for more details.
+
+  You should have received a copy of the GNU Lesser General
+  Public License along with this library; if not, write to the
+  Free Software Foundation, Inc., 59 Temple Place, Suite 330,
+  Boston, MA  02111-1307  USA
+*/
+
+#include "wiring_private.h"
+
+// the prescaler is set so that timer0 ticks every 64 clock cycles, and the
+// the overflow handler is called every 256 ticks.
+#define MICROSECONDS_PER_TIMER0_OVERFLOW (clockCyclesToMicroseconds(64 * 256))
+
+// the whole number of milliseconds per timer0 overflow
+#define MILLIS_INC (MICROSECONDS_PER_TIMER0_OVERFLOW / 1000)
+
+// the fractional number of milliseconds per timer0 overflow. we shift right
+// by three to fit these numbers into a byte. (for the clock speeds we care
+// about - 8 and 16 MHz - this doesn't lose precision.)
+#define FRACT_INC ((MICROSECONDS_PER_TIMER0_OVERFLOW % 1000) >> 3)
+#define FRACT_MAX (1000 >> 3)
+
+volatile unsigned long timer0_overflow_count = 0;
+volatile unsigned long timer0_millis = 0;
+static unsigned char timer0_fract = 0;
+
+#if defined(TIM0_OVF_vect)
+ISR(TIM0_OVF_vect)
+#else
+ISR(TIMER0_OVF_vect)
+#endif
+{
+	// copy these to local variables so they can be stored in registers
+	// (volatile variables must be read from memory on every access)
+	unsigned long m = timer0_millis;
+	unsigned char f = timer0_fract;
+
+	m += MILLIS_INC;
+	f += FRACT_INC;
+	if (f >= FRACT_MAX) {
+		f -= FRACT_MAX;
+		m += 1;
+	}
+
+	timer0_fract = f;
+	timer0_millis = m;
+	timer0_overflow_count++;
+}
+
+unsigned long millis()
+{
+	unsigned long m;
+	uint8_t oldSREG = SREG;
+
+	// disable interrupts while we read timer0_millis or we might get an
+	// inconsistent value (e.g. in the middle of a write to timer0_millis)
+	cli();
+	m = timer0_millis;
+	SREG = oldSREG;
+
+	return m;
+}
+
+unsigned long micros() {
+	unsigned long m;
+	uint8_t oldSREG = SREG, t;
+	
+	cli();
+	m = timer0_overflow_count;
+#if defined(TCNT0)
+	t = TCNT0;
+#elif defined(TCNT0L)
+	t = TCNT0L;
+#else
+	#error TIMER 0 not defined
+#endif
+
+#ifdef TIFR0
+	if ((TIFR0 & _BV(TOV0)) && (t < 255))
+		m++;
+#else
+	if ((TIFR & _BV(TOV0)) && (t < 255))
+		m++;
+#endif
+
+	SREG = oldSREG;
+	
+	return ((m << 8) + t) * (64 / clockCyclesPerMicrosecond());
+}
+
+void delay(unsigned long ms)
+{
+	uint32_t start = micros();
+
+	while (ms > 0) {
+		yield();
+		while ( ms > 0 && (micros() - start) >= 1000) {
+			ms--;
+			start += 1000;
+		}
+	}
+}
+
+/* Delay for the given number of microseconds.  Assumes a 1, 8, 12, 16, 20 or 24 MHz clock. */
+void delayMicroseconds(unsigned int us)
+{
+	// call = 4 cycles + 2 to 4 cycles to init us(2 for constant delay, 4 for variable)
+
+	// calling avrlib's delay_us() function with low values (e.g. 1 or
+	// 2 microseconds) gives delays longer than desired.
+	//delay_us(us);
+#if F_CPU >= 24000000L
+	// for the 24 MHz clock for the adventurous ones trying to overclock
+
+	// zero delay fix
+	if (!us) return; //  = 3 cycles, (4 when true)
+
+	// the following loop takes a 1/6 of a microsecond (4 cycles)
+	// per iteration, so execute it six times for each microsecond of
+	// delay requested.
+	us *= 6; // x6 us, = 7 cycles
+
+	// account for the time taken in the preceding commands.
+	// we just burned 22 (24) cycles above, remove 5, (5*4=20)
+	// us is at least 6 so we can subtract 5
+	us -= 5; //=2 cycles
+
+#elif F_CPU >= 20000000L
+	// for the 20 MHz clock on rare Arduino boards
+
+	// for a one-microsecond delay, simply return.  the overhead
+	// of the function call takes 18 (20) cycles, which is 1us
+	__asm__ __volatile__ (
+		"nop" "\n\t"
+		"nop" "\n\t"
+		"nop" "\n\t"
+		"nop"); //just waiting 4 cycles
+	if (us <= 1) return; //  = 3 cycles, (4 when true)
+
+	// the following loop takes a 1/5 of a microsecond (4 cycles)
+	// per iteration, so execute it five times for each microsecond of
+	// delay requested.
+	us = (us << 2) + us; // x5 us, = 7 cycles
+
+	// account for the time taken in the preceding commands.
+	// we just burned 26 (28) cycles above, remove 7, (7*4=28)
+	// us is at least 10 so we can subtract 7
+	us -= 7; // 2 cycles
+
+#elif F_CPU >= 16000000L
+	// for the 16 MHz clock on most Arduino boards
+
+	// for a one-microsecond delay, simply return.  the overhead
+	// of the function call takes 14 (16) cycles, which is 1us
+	if (us <= 1) return; //  = 3 cycles, (4 when true)
+
+	// the following loop takes 1/4 of a microsecond (4 cycles)
+	// per iteration, so execute it four times for each microsecond of
+	// delay requested.
+	us <<= 2; // x4 us, = 4 cycles
+
+	// account for the time taken in the preceding commands.
+	// we just burned 19 (21) cycles above, remove 5, (5*4=20)
+	// us is at least 8 so we can subtract 5
+	us -= 5; // = 2 cycles,
+
+#elif F_CPU >= 12000000L
+	// for the 12 MHz clock if somebody is working with USB
+
+	// for a 1 microsecond delay, simply return.  the overhead
+	// of the function call takes 14 (16) cycles, which is 1.5us
+	if (us <= 1) return; //  = 3 cycles, (4 when true)
+
+	// the following loop takes 1/3 of a microsecond (4 cycles)
+	// per iteration, so execute it three times for each microsecond of
+	// delay requested.
+	us = (us << 1) + us; // x3 us, = 5 cycles
+
+	// account for the time taken in the preceding commands.
+	// we just burned 20 (22) cycles above, remove 5, (5*4=20)
+	// us is at least 6 so we can subtract 5
+	us -= 5; //2 cycles
+
+#elif F_CPU >= 8000000L
+	// for the 8 MHz internal clock
+
+	// for a 1 and 2 microsecond delay, simply return.  the overhead
+	// of the function call takes 14 (16) cycles, which is 2us
+	if (us <= 2) return; //  = 3 cycles, (4 when true)
+
+	// the following loop takes 1/2 of a microsecond (4 cycles)
+	// per iteration, so execute it twice for each microsecond of
+	// delay requested.
+	us <<= 1; //x2 us, = 2 cycles
+
+	// account for the time taken in the preceding commands.
+	// we just burned 17 (19) cycles above, remove 4, (4*4=16)
+	// us is at least 6 so we can subtract 4
+	us -= 4; // = 2 cycles
+
+#else
+	// for the 1 MHz internal clock (default settings for common Atmega microcontrollers)
+
+	// the overhead of the function calls is 14 (16) cycles
+	if (us <= 16) return; //= 3 cycles, (4 when true)
+	if (us <= 25) return; //= 3 cycles, (4 when true), (must be at least 25 if we want to subtract 22)
+
+	// compensate for the time taken by the preceding and next commands (about 22 cycles)
+	us -= 22; // = 2 cycles
+	// the following loop takes 4 microseconds (4 cycles)
+	// per iteration, so execute it us/4 times
+	// us is at least 4, divided by 4 gives us 1 (no zero delay bug)
+	us >>= 2; // us div 4, = 4 cycles
+	
+
+#endif
+
+	// busy wait
+	__asm__ __volatile__ (
+		"1: sbiw %0,1" "\n\t" // 2 cycles
+		"brne 1b" : "=w" (us) : "0" (us) // 2 cycles
+	);
+	// return = 4 cycles
+}
+
+void init()
+{
+	// this needs to be called before setup() or some functions won't
+	// work there
+	sei();
+	
+	// on the ATmega168, timer 0 is also used for fast hardware pwm
+	// (using phase-correct PWM would mean that timer 0 overflowed half as often
+	// resulting in different millis() behavior on the ATmega8 and ATmega168)
+#if defined(TCCR0A) && defined(WGM01)
+	sbi(TCCR0A, WGM01);
+	sbi(TCCR0A, WGM00);
+#endif
+
+	// set timer 0 prescale factor to 64
+#if defined(__AVR_ATmega128__)
+	// CPU specific: different values for the ATmega128
+	sbi(TCCR0, CS02);
+#elif defined(TCCR0) && defined(CS01) && defined(CS00)
+	// this combination is for the standard atmega8
+	sbi(TCCR0, CS01);
+	sbi(TCCR0, CS00);
+#elif defined(TCCR0B) && defined(CS01) && defined(CS00)
+	// this combination is for the standard 168/328/1280/2560
+	sbi(TCCR0B, CS01);
+	sbi(TCCR0B, CS00);
+#elif defined(TCCR0A) && defined(CS01) && defined(CS00)
+	// this combination is for the __AVR_ATmega645__ series
+	sbi(TCCR0A, CS01);
+	sbi(TCCR0A, CS00);
+#else
+	#error Timer 0 prescale factor 64 not set correctly
+#endif
+
+	// enable timer 0 overflow interrupt
+#if defined(TIMSK) && defined(TOIE0)
+	sbi(TIMSK, TOIE0);
+#elif defined(TIMSK0) && defined(TOIE0)
+	sbi(TIMSK0, TOIE0);
+#else
+	#error	Timer 0 overflow interrupt not set correctly
+#endif
+
+	// timers 1 and 2 are used for phase-correct hardware pwm
+	// this is better for motors as it ensures an even waveform
+	// note, however, that fast pwm mode can achieve a frequency of up
+	// 8 MHz (with a 16 MHz clock) at 50% duty cycle
+
+#if defined(TCCR1B) && defined(CS11) && defined(CS10)
+	TCCR1B = 0;
+
+	// set timer 1 prescale factor to 64
+	sbi(TCCR1B, CS11);
+#if F_CPU >= 8000000L
+	sbi(TCCR1B, CS10);
+#endif
+#elif defined(TCCR1) && defined(CS11) && defined(CS10)
+	sbi(TCCR1, CS11);
+#if F_CPU >= 8000000L
+	sbi(TCCR1, CS10);
+#endif
+#endif
+	// put timer 1 in 8-bit phase correct pwm mode
+#if defined(TCCR1A) && defined(WGM10)
+	sbi(TCCR1A, WGM10);
+#endif
+
+	// set timer 2 prescale factor to 64
+#if defined(TCCR2) && defined(CS22)
+	sbi(TCCR2, CS22);
+#elif defined(TCCR2B) && defined(CS22)
+	sbi(TCCR2B, CS22);
+//#else
+	// Timer 2 not finished (may not be present on this CPU)
+#endif
+
+	// configure timer 2 for phase correct pwm (8-bit)
+#if defined(TCCR2) && defined(WGM20)
+	sbi(TCCR2, WGM20);
+#elif defined(TCCR2A) && defined(WGM20)
+	sbi(TCCR2A, WGM20);
+//#else
+	// Timer 2 not finished (may not be present on this CPU)
+#endif
+
+#if defined(TCCR3B) && defined(CS31) && defined(WGM30)
+	sbi(TCCR3B, CS31);		// set timer 3 prescale factor to 64
+	sbi(TCCR3B, CS30);
+	sbi(TCCR3A, WGM30);		// put timer 3 in 8-bit phase correct pwm mode
+#endif
+
+#if defined(TCCR4A) && defined(TCCR4B) && defined(TCCR4D) /* beginning of timer4 block for 32U4 and similar */
+	sbi(TCCR4B, CS42);		// set timer4 prescale factor to 64
+	sbi(TCCR4B, CS41);
+	sbi(TCCR4B, CS40);
+	sbi(TCCR4D, WGM40);		// put timer 4 in phase- and frequency-correct PWM mode	
+	sbi(TCCR4A, PWM4A);		// enable PWM mode for comparator OCR4A
+	sbi(TCCR4C, PWM4D);		// enable PWM mode for comparator OCR4D
+#else /* beginning of timer4 block for ATMEGA1280 and ATMEGA2560 */
+#if defined(TCCR4B) && defined(CS41) && defined(WGM40)
+	sbi(TCCR4B, CS41);		// set timer 4 prescale factor to 64
+	sbi(TCCR4B, CS40);
+	sbi(TCCR4A, WGM40);		// put timer 4 in 8-bit phase correct pwm mode
+#endif
+#endif /* end timer4 block for ATMEGA1280/2560 and similar */	
+
+#if defined(TCCR5B) && defined(CS51) && defined(WGM50)
+	sbi(TCCR5B, CS51);		// set timer 5 prescale factor to 64
+	sbi(TCCR5B, CS50);
+	sbi(TCCR5A, WGM50);		// put timer 5 in 8-bit phase correct pwm mode
+#endif
+
+#if defined(ADCSRA)
+	// set a2d prescaler so we are inside the desired 50-200 KHz range.
+	#if F_CPU >= 16000000 // 16 MHz / 128 = 125 KHz
+		sbi(ADCSRA, ADPS2);
+		sbi(ADCSRA, ADPS1);
+		sbi(ADCSRA, ADPS0);
+	#elif F_CPU >= 8000000 // 8 MHz / 64 = 125 KHz
+		sbi(ADCSRA, ADPS2);
+		sbi(ADCSRA, ADPS1);
+		cbi(ADCSRA, ADPS0);
+	#elif F_CPU >= 4000000 // 4 MHz / 32 = 125 KHz
+		sbi(ADCSRA, ADPS2);
+		cbi(ADCSRA, ADPS1);
+		sbi(ADCSRA, ADPS0);
+	#elif F_CPU >= 2000000 // 2 MHz / 16 = 125 KHz
+		sbi(ADCSRA, ADPS2);
+		cbi(ADCSRA, ADPS1);
+		cbi(ADCSRA, ADPS0);
+	#elif F_CPU >= 1000000 // 1 MHz / 8 = 125 KHz
+		cbi(ADCSRA, ADPS2);
+		sbi(ADCSRA, ADPS1);
+		sbi(ADCSRA, ADPS0);
+	#else // 128 kHz / 2 = 64 KHz -> This is the closest you can get, the prescaler is 2
+		cbi(ADCSRA, ADPS2);
+		cbi(ADCSRA, ADPS1);
+		sbi(ADCSRA, ADPS0);
+	#endif
+	// enable a2d conversions
+	sbi(ADCSRA, ADEN);
+#endif
+
+	// the bootloader connects pins 0 and 1 to the USART; disconnect them
+	// here so they can be used as normal digital i/o; they will be
+	// reconnected in Serial.begin()
+#if defined(UCSRB)
+	UCSRB = 0;
+#elif defined(UCSR0B)
+	UCSR0B = 0;
+#endif
+}

cores/arduino/wiring_analog.c

@@ -0,0 +1,286 @@
+/*
+  wiring_analog.c - analog input and output
+  Part of Arduino - http://www.arduino.cc/
+
+  Copyright (c) 2005-2006 David A. Mellis
+
+  This library is free software; you can redistribute it and/or
+  modify it under the terms of the GNU Lesser General Public
+  License as published by the Free Software Foundation; either
+  version 2.1 of the License, or (at your option) any later version.
+
+  This library 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
+  Lesser General Public License for more details.
+
+  You should have received a copy of the GNU Lesser General
+  Public License along with this library; if not, write to the
+  Free Software Foundation, Inc., 59 Temple Place, Suite 330,
+  Boston, MA  02111-1307  USA
+
+  Modified 28 September 2010 by Mark Sproul
+*/
+
+#include "wiring_private.h"
+#include "pins_arduino.h"
+
+uint8_t analog_reference = DEFAULT;
+
+void analogReference(uint8_t mode)
+{
+	// can't actually set the register here because the default setting
+	// will connect AVCC and the AREF pin, which would cause a short if
+	// there's something connected to AREF.
+	analog_reference = mode;
+}
+
+int analogRead(uint8_t pin)
+{
+
+#if defined(analogPinToChannel)
+#if defined(__AVR_ATmega32U4__)
+	if (pin >= 18) pin -= 18; // allow for channel or pin numbers
+#endif
+	pin = analogPinToChannel(pin);
+#elif defined(__AVR_ATmega1280__) || defined(__AVR_ATmega2560__)
+	if (pin >= 54) pin -= 54; // allow for channel or pin numbers
+#elif defined(__AVR_ATmega32U4__)
+	if (pin >= 18) pin -= 18; // allow for channel or pin numbers
+#elif defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__) || defined(__AVR_ATmega644__) || defined(__AVR_ATmega644A__) || defined(__AVR_ATmega644P__) || defined(__AVR_ATmega644PA__)
+	if (pin >= 24) pin -= 24; // allow for channel or pin numbers
+#else
+	if (pin >= 14) pin -= 14; // allow for channel or pin numbers
+#endif
+
+#if defined(ADCSRB) && defined(MUX5)
+	// the MUX5 bit of ADCSRB selects whether we're reading from channels
+	// 0 to 7 (MUX5 low) or 8 to 15 (MUX5 high).
+	ADCSRB = (ADCSRB & ~(1 << MUX5)) | (((pin >> 3) & 0x01) << MUX5);
+#endif
+  
+	// set the analog reference (high two bits of ADMUX) and select the
+	// channel (low 4 bits).  this also sets ADLAR (left-adjust result)
+	// to 0 (the default).
+#if defined(ADMUX)
+#if defined(__AVR_ATtiny25__) || defined(__AVR_ATtiny45__) || defined(__AVR_ATtiny85__)
+	ADMUX = (analog_reference << 4) | (pin & 0x07);
+#else
+	ADMUX = (analog_reference << 6) | (pin & 0x07);
+#endif
+#endif
+
+	// without a delay, we seem to read from the wrong channel
+	//delay(1);
+
+#if defined(ADCSRA) && defined(ADC)
+	// start the conversion
+	sbi(ADCSRA, ADSC);
+
+	// ADSC is cleared when the conversion finishes
+	while (bit_is_set(ADCSRA, ADSC));
+
+	// ADC macro takes care of reading ADC register.
+	// avr-gcc implements the proper reading order: ADCL is read first.
+	return ADC;
+#else
+	// we dont have an ADC, return 0
+	return 0;
+#endif
+}
+
+// Right now, PWM output only works on the pins with
+// hardware support.  These are defined in the appropriate
+// pins_*.c file.  For the rest of the pins, we default
+// to digital output.
+void analogWrite(uint8_t pin, int val)
+{
+	// We need to make sure the PWM output is enabled for those pins
+	// that support it, as we turn it off when digitally reading or
+	// writing with them.  Also, make sure the pin is in output mode
+	// for consistenty with Wiring, which doesn't require a pinMode
+	// call for the analog output pins.
+	pinMode(pin, OUTPUT);
+	if (val == 0)
+	{
+		digitalWrite(pin, LOW);
+	}
+	else if (val == 255)
+	{
+		digitalWrite(pin, HIGH);
+	}
+	else
+	{
+		switch(digitalPinToTimer(pin))
+		{
+			// XXX fix needed for atmega8
+			#if defined(TCCR0) && defined(COM00) && !defined(__AVR_ATmega8__)
+			case TIMER0A:
+				// connect pwm to pin on timer 0
+				sbi(TCCR0, COM00);
+				OCR0 = val; // set pwm duty
+				break;
+			#endif
+
+			#if defined(TCCR0A) && defined(COM0A1)
+			case TIMER0A:
+				// connect pwm to pin on timer 0, channel A
+				sbi(TCCR0A, COM0A1);
+				OCR0A = val; // set pwm duty
+				break;
+			#endif
+
+			#if defined(TCCR0A) && defined(COM0B1)
+			case TIMER0B:
+				// connect pwm to pin on timer 0, channel B
+				sbi(TCCR0A, COM0B1);
+				OCR0B = val; // set pwm duty
+				break;
+			#endif
+
+			#if defined(TCCR1A) && defined(COM1A1)
+			case TIMER1A:
+				// connect pwm to pin on timer 1, channel A
+				sbi(TCCR1A, COM1A1);
+				OCR1A = val; // set pwm duty
+				break;
+			#endif
+
+			#if defined(TCCR1A) && defined(COM1B1)
+			case TIMER1B:
+				// connect pwm to pin on timer 1, channel B
+				sbi(TCCR1A, COM1B1);
+				OCR1B = val; // set pwm duty
+				break;
+			#endif
+
+			#if defined(TCCR1A) && defined(COM1C1)
+			case TIMER1C:
+				// connect pwm to pin on timer 1, channel C
+				sbi(TCCR1A, COM1C1);
+				OCR1C = val; // set pwm duty
+				break;
+			#endif
+
+			#if defined(TCCR2) && defined(COM21)
+			case TIMER2:
+				// connect pwm to pin on timer 2
+				sbi(TCCR2, COM21);
+				OCR2 = val; // set pwm duty
+				break;
+			#endif
+
+			#if defined(TCCR2A) && defined(COM2A1)
+			case TIMER2A:
+				// connect pwm to pin on timer 2, channel A
+				sbi(TCCR2A, COM2A1);
+				OCR2A = val; // set pwm duty
+				break;
+			#endif
+
+			#if defined(TCCR2A) && defined(COM2B1)
+			case TIMER2B:
+				// connect pwm to pin on timer 2, channel B
+				sbi(TCCR2A, COM2B1);
+				OCR2B = val; // set pwm duty
+				break;
+			#endif
+
+			#if defined(TCCR3A) && defined(COM3A1)
+			case TIMER3A:
+				// connect pwm to pin on timer 3, channel A
+				sbi(TCCR3A, COM3A1);
+				OCR3A = val; // set pwm duty
+				break;
+			#endif
+
+			#if defined(TCCR3A) && defined(COM3B1)
+			case TIMER3B:
+				// connect pwm to pin on timer 3, channel B
+				sbi(TCCR3A, COM3B1);
+				OCR3B = val; // set pwm duty
+				break;
+			#endif
+
+			#if defined(TCCR3A) && defined(COM3C1)
+			case TIMER3C:
+				// connect pwm to pin on timer 3, channel C
+				sbi(TCCR3A, COM3C1);
+				OCR3C = val; // set pwm duty
+				break;
+			#endif
+
+			#if defined(TCCR4A)
+			case TIMER4A:
+				//connect pwm to pin on timer 4, channel A
+				sbi(TCCR4A, COM4A1);
+				#if defined(COM4A0)		// only used on 32U4
+				cbi(TCCR4A, COM4A0);
+				#endif
+				OCR4A = val;	// set pwm duty
+				break;
+			#endif
+			
+			#if defined(TCCR4A) && defined(COM4B1)
+			case TIMER4B:
+				// connect pwm to pin on timer 4, channel B
+				sbi(TCCR4A, COM4B1);
+				OCR4B = val; // set pwm duty
+				break;
+			#endif
+
+			#if defined(TCCR4A) && defined(COM4C1)
+			case TIMER4C:
+				// connect pwm to pin on timer 4, channel C
+				sbi(TCCR4A, COM4C1);
+				OCR4C = val; // set pwm duty
+				break;
+			#endif
+				
+			#if defined(TCCR4C) && defined(COM4D1)
+			case TIMER4D:				
+				// connect pwm to pin on timer 4, channel D
+				sbi(TCCR4C, COM4D1);
+				#if defined(COM4D0)		// only used on 32U4
+				cbi(TCCR4C, COM4D0);
+				#endif
+				OCR4D = val;	// set pwm duty
+				break;
+			#endif
+
+							
+			#if defined(TCCR5A) && defined(COM5A1)
+			case TIMER5A:
+				// connect pwm to pin on timer 5, channel A
+				sbi(TCCR5A, COM5A1);
+				OCR5A = val; // set pwm duty
+				break;
+			#endif
+
+			#if defined(TCCR5A) && defined(COM5B1)
+			case TIMER5B:
+				// connect pwm to pin on timer 5, channel B
+				sbi(TCCR5A, COM5B1);
+				OCR5B = val; // set pwm duty
+				break;
+			#endif
+
+			#if defined(TCCR5A) && defined(COM5C1)
+			case TIMER5C:
+				// connect pwm to pin on timer 5, channel C
+				sbi(TCCR5A, COM5C1);
+				OCR5C = val; // set pwm duty
+				break;
+			#endif
+
+			case NOT_ON_TIMER:
+			default:
+				if (val < 128) {
+					digitalWrite(pin, LOW);
+				} else {
+					digitalWrite(pin, HIGH);
+				}
+		}
+	}
+}
+

cores/arduino/wiring_digital.c

@@ -0,0 +1,179 @@
+/*
+  wiring_digital.c - digital input and output functions
+  Part of Arduino - http://www.arduino.cc/
+
+  Copyright (c) 2005-2006 David A. Mellis
+
+  This library is free software; you can redistribute it and/or
+  modify it under the terms of the GNU Lesser General Public
+  License as published by the Free Software Foundation; either
+  version 2.1 of the License, or (at your option) any later version.
+
+  This library 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
+  Lesser General Public License for more details.
+
+  You should have received a copy of the GNU Lesser General
+  Public License along with this library; if not, write to the
+  Free Software Foundation, Inc., 59 Temple Place, Suite 330,
+  Boston, MA  02111-1307  USA
+
+  Modified 28 September 2010 by Mark Sproul
+*/
+
+#define ARDUINO_MAIN
+#include "wiring_private.h"
+#include "pins_arduino.h"
+
+void pinMode(uint8_t pin, uint8_t mode)
+{
+	uint8_t bit = digitalPinToBitMask(pin);
+	uint8_t port = digitalPinToPort(pin);
+	volatile uint8_t *reg, *out;
+
+	if (port == NOT_A_PIN) return;
+
+	// JWS: can I let the optimizer do this?
+	reg = portModeRegister(port);
+	out = portOutputRegister(port);
+
+	if (mode == INPUT) { 
+		uint8_t oldSREG = SREG;
+                cli();
+		*reg &= ~bit;
+		*out &= ~bit;
+		SREG = oldSREG;
+	} else if (mode == INPUT_PULLUP) {
+		uint8_t oldSREG = SREG;
+                cli();
+		*reg &= ~bit;
+		*out |= bit;
+		SREG = oldSREG;
+	} else {
+		uint8_t oldSREG = SREG;
+                cli();
+		*reg |= bit;
+		SREG = oldSREG;
+	}
+}
+
+// Forcing this inline keeps the callers from having to push their own stuff
+// on the stack. It is a good performance win and only takes 1 more byte per
+// user than calling. (It will take more bytes on the 168.)
+//
+// But shouldn't this be moved into pinMode? Seems silly to check and do on
+// each digitalread or write.
+//
+// Mark Sproul:
+// - Removed inline. Save 170 bytes on atmega1280
+// - changed to a switch statement; added 32 bytes but much easier to read and maintain.
+// - Added more #ifdefs, now compiles for atmega645
+//
+//static inline void turnOffPWM(uint8_t timer) __attribute__ ((always_inline));
+//static inline void turnOffPWM(uint8_t timer)
+static void turnOffPWM(uint8_t timer)
+{
+	switch (timer)
+	{
+		#if defined(TCCR1A) && defined(COM1A1)
+		case TIMER1A:   cbi(TCCR1A, COM1A1);    break;
+		#endif
+		#if defined(TCCR1A) && defined(COM1B1)
+		case TIMER1B:   cbi(TCCR1A, COM1B1);    break;
+		#endif
+		#if defined(TCCR1A) && defined(COM1C1)
+		case TIMER1C:   cbi(TCCR1A, COM1C1);    break;
+		#endif
+		
+		#if defined(TCCR2) && defined(COM21)
+		case  TIMER2:   cbi(TCCR2, COM21);      break;
+		#endif
+		
+		#if defined(TCCR0A) && defined(COM0A1)
+		case  TIMER0A:  cbi(TCCR0A, COM0A1);    break;
+		#endif
+		
+		#if defined(TCCR0A) && defined(COM0B1)
+		case  TIMER0B:  cbi(TCCR0A, COM0B1);    break;
+		#endif
+		#if defined(TCCR2A) && defined(COM2A1)
+		case  TIMER2A:  cbi(TCCR2A, COM2A1);    break;
+		#endif
+		#if defined(TCCR2A) && defined(COM2B1)
+		case  TIMER2B:  cbi(TCCR2A, COM2B1);    break;
+		#endif
+		
+		#if defined(TCCR3A) && defined(COM3A1)
+		case  TIMER3A:  cbi(TCCR3A, COM3A1);    break;
+		#endif
+		#if defined(TCCR3A) && defined(COM3B1)
+		case  TIMER3B:  cbi(TCCR3A, COM3B1);    break;
+		#endif
+		#if defined(TCCR3A) && defined(COM3C1)
+		case  TIMER3C:  cbi(TCCR3A, COM3C1);    break;
+		#endif
+
+		#if defined(TCCR4A) && defined(COM4A1)
+		case  TIMER4A:  cbi(TCCR4A, COM4A1);    break;
+		#endif					
+		#if defined(TCCR4A) && defined(COM4B1)
+		case  TIMER4B:  cbi(TCCR4A, COM4B1);    break;
+		#endif
+		#if defined(TCCR4A) && defined(COM4C1)
+		case  TIMER4C:  cbi(TCCR4A, COM4C1);    break;
+		#endif			
+		#if defined(TCCR4C) && defined(COM4D1)
+		case TIMER4D:	cbi(TCCR4C, COM4D1);	break;
+		#endif			
+			
+		#if defined(TCCR5A)
+		case  TIMER5A:  cbi(TCCR5A, COM5A1);    break;
+		case  TIMER5B:  cbi(TCCR5A, COM5B1);    break;
+		case  TIMER5C:  cbi(TCCR5A, COM5C1);    break;
+		#endif
+	}
+}
+
+void digitalWrite(uint8_t pin, uint8_t val)
+{
+	uint8_t timer = digitalPinToTimer(pin);
+	uint8_t bit = digitalPinToBitMask(pin);
+	uint8_t port = digitalPinToPort(pin);
+	volatile uint8_t *out;
+
+	if (port == NOT_A_PIN) return;
+
+	// If the pin that support PWM output, we need to turn it off
+	// before doing a digital write.
+	if (timer != NOT_ON_TIMER) turnOffPWM(timer);
+
+	out = portOutputRegister(port);
+
+	uint8_t oldSREG = SREG;
+	cli();
+
+	if (val == LOW) {
+		*out &= ~bit;
+	} else {
+		*out |= bit;
+	}
+
+	SREG = oldSREG;
+}
+
+int digitalRead(uint8_t pin)
+{
+	uint8_t timer = digitalPinToTimer(pin);
+	uint8_t bit = digitalPinToBitMask(pin);
+	uint8_t port = digitalPinToPort(pin);
+
+	if (port == NOT_A_PIN) return LOW;
+
+	// If the pin that support PWM output, we need to turn it off
+	// before getting a digital reading.
+	if (timer != NOT_ON_TIMER) turnOffPWM(timer);
+
+	if (*portInputRegister(port) & bit) return HIGH;
+	return LOW;
+}

cores/arduino/wiring_private.h

@@ -0,0 +1,72 @@
+/*
+  wiring_private.h - Internal header file.
+  Part of Arduino - http://www.arduino.cc/
+
+  Copyright (c) 2005-2006 David A. Mellis
+
+  This library is free software; you can redistribute it and/or
+  modify it under the terms of the GNU Lesser General Public
+  License as published by the Free Software Foundation; either
+  version 2.1 of the License, or (at your option) any later version.
+
+  This library 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
+  Lesser General Public License for more details.
+
+  You should have received a copy of the GNU Lesser General
+  Public License along with this library; if not, write to the
+  Free Software Foundation, Inc., 59 Temple Place, Suite 330,
+  Boston, MA  02111-1307  USA
+*/
+
+#ifndef WiringPrivate_h
+#define WiringPrivate_h
+
+#include <avr/io.h>
+#include <avr/interrupt.h>
+#include <stdio.h>
+#include <stdarg.h>
+
+#include "Arduino.h"
+
+#ifdef __cplusplus
+extern "C"{
+#endif
+
+#ifndef cbi
+#define cbi(sfr, bit) (_SFR_BYTE(sfr) &= ~_BV(bit))
+#endif
+#ifndef sbi
+#define sbi(sfr, bit) (_SFR_BYTE(sfr) |= _BV(bit))
+#endif
+
+uint32_t countPulseASM(volatile uint8_t *port, uint8_t bit, uint8_t stateMask, unsigned long maxloops);
+
+#define EXTERNAL_INT_0 0
+#define EXTERNAL_INT_1 1
+#define EXTERNAL_INT_2 2
+#define EXTERNAL_INT_3 3
+#define EXTERNAL_INT_4 4
+#define EXTERNAL_INT_5 5
+#define EXTERNAL_INT_6 6
+#define EXTERNAL_INT_7 7
+
+#if defined(__AVR_ATmega1280__) || defined(__AVR_ATmega2560__) || defined(__AVR_ATmega128RFA1__) || defined(__AVR_ATmega256RFR2__) || \
+    defined(__AVR_AT90USB82__) || defined(__AVR_AT90USB162__) || defined(__AVR_ATmega32U2__) || defined(__AVR_ATmega16U2__) || defined(__AVR_ATmega8U2__)
+#define EXTERNAL_NUM_INTERRUPTS 8
+#elif defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__) || defined(__AVR_ATmega644__) || defined(__AVR_ATmega644A__) || defined(__AVR_ATmega644P__) || defined(__AVR_ATmega644PA__)
+#define EXTERNAL_NUM_INTERRUPTS 3
+#elif defined(__AVR_ATmega32U4__)
+#define EXTERNAL_NUM_INTERRUPTS 5
+#else
+#define EXTERNAL_NUM_INTERRUPTS 2
+#endif
+
+typedef void (*voidFuncPtr)(void);
+
+#ifdef __cplusplus
+} // extern "C"
+#endif
+
+#endif

cores/arduino/wiring_pulse.S

@@ -0,0 +1,178 @@
+/*
+  wiring_pulse.s - pulseInASM() function in different flavours
+  Part of Arduino - http://www.arduino.cc/
+
+  Copyright (c) 2014 Martino Facchin
+
+  This library is free software; you can redistribute it and/or
+  modify it under the terms of the GNU Lesser General Public
+  License as published by the Free Software Foundation; either
+  version 2.1 of the License, or (at your option) any later version.
+
+  This library 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
+  Lesser General Public License for more details.
+
+  You should have received a copy of the GNU Lesser General
+  Public License along with this library; if not, write to the
+  Free Software Foundation, Inc., 59 Temple Place, Suite 330,
+  Boston, MA  02111-1307  USA
+*/
+
+/*
+ * The following routine was generated by avr-gcc 4.8.3 with the following parameters
+ * -gstabs -Wa,-ahlmsd=output.lst -dp -fverbose-asm -O2
+ * on the original C function
+ *
+ * unsigned long pulseInSimpl(volatile uint8_t *port, uint8_t bit, uint8_t stateMask, unsigned long maxloops)
+ * {
+ *     unsigned long width = 0;
+ *     // wait for any previous pulse to end
+ *     while ((*port & bit) == stateMask)
+ *         if (--maxloops == 0)
+ *             return 0;
+ *
+ *     // wait for the pulse to start
+ *     while ((*port & bit) != stateMask)
+ *         if (--maxloops == 0)
+ *             return 0;
+ *
+ *     // wait for the pulse to stop
+ *     while ((*port & bit) == stateMask) {
+ *         if (++width == maxloops)
+ *             return 0;
+ *     }
+ *     return width;
+ * }
+ *
+ * some compiler outputs were removed but the rest of the code is untouched
+ */
+
+#include <avr/io.h>
+
+.section .text
+
+.global countPulseASM
+
+countPulseASM:
+
+.LM0:
+.LFBB1:
+    push r12   ;   ;  130 pushqi1/1 [length = 1]
+    push r13   ;   ;  131 pushqi1/1 [length = 1]
+    push r14   ;   ;  132 pushqi1/1 [length = 1]
+    push r15   ;   ;  133 pushqi1/1 [length = 1]
+    push r16   ;   ;  134 pushqi1/1 [length = 1]
+    push r17   ;   ;  135 pushqi1/1 [length = 1]
+/* prologue: function */
+/* frame size = 0 */
+/* stack size = 6 */
+.L__stack_usage = 6
+    mov r30,r24  ;  port, port   ;  2 *movhi/1  [length = 2]
+    mov r31,r25  ;  port, port
+/*     unsigned long width = 0;
+***     // wait for any previous pulse to end
+***     while ((*port & bit) == stateMask)
+*/
+.LM1:
+    rjmp .L2   ;   ;  181 jump  [length = 1]
+.L4:
+/*         if (--maxloops == 0) */
+.LM2:
+    subi r16,1   ;  maxloops,  ;  17  addsi3/2  [length = 4]
+    sbc r17, r1   ;  maxloops
+    sbc r18, r1   ;  maxloops
+    sbc r19, r1   ;  maxloops
+    breq .L13  ; ,   ;  19  branch  [length = 1]
+.L2:
+/*         if (--maxloops == 0) */
+.LM3:
+    ld r25,Z   ;  D.1554, *port_7(D)   ;  22  movqi_insn/4  [length = 1]
+    and r25,r22  ;  D.1554, bit  ;  24  andqi3/1  [length = 1]
+    cp r25,r20   ;  D.1554, stateMask  ;  25  *cmpqi/2  [length = 1]
+    breq .L4   ; ,   ;  26  branch  [length = 1]
+    rjmp .L6   ;   ;  184 jump  [length = 1]
+.L7:
+/*             return 0;
+***
+***     // wait for the pulse to start
+***     while ((*port & bit) != stateMask)
+***         if (--maxloops == 0)
+*/
+.LM4:
+    subi r16,1   ;  maxloops,  ;  31  addsi3/2  [length = 4]
+    sbc r17, r1   ;  maxloops
+    sbc r18, r1   ;  maxloops
+    sbc r19, r1   ;  maxloops
+    breq .L13  ; ,   ;  33  branch  [length = 1]
+.L6:
+/*         if (--maxloops == 0) */
+.LM5:
+    ld r25,Z   ;  D.1554, *port_7(D)   ;  41  movqi_insn/4  [length = 1]
+    and r25,r22  ;  D.1554, bit  ;  43  andqi3/1  [length = 1]
+    cpse r25,r20   ;  D.1554, stateMask  ;  44  enable_interrupt-3  [length = 1]
+    rjmp .L7   ;
+    mov r12, r1   ;  width  ;  7 *movsi/2  [length = 4]
+    mov r13, r1   ;  width
+    mov r14, r1   ;  width
+    mov r15, r1   ;  width
+    rjmp .L9   ;   ;  186 jump  [length = 1]
+.L10:
+/*             return 0;
+***
+***     // wait for the pulse to stop
+***     while ((*port & bit) == stateMask) {
+***         if (++width == maxloops)
+*/
+.LM6:
+    ldi r24,-1   ; ,   ;  50  addsi3/3  [length = 5]
+    sub r12,r24  ;  width,
+    sbc r13,r24  ;  width,
+    sbc r14,r24  ;  width,
+    sbc r15,r24  ;  width,
+    cp r16,r12   ;  maxloops, width  ;  51  *cmpsi/2  [length = 4]
+    cpc r17,r13  ;  maxloops, width
+    cpc r18,r14  ;  maxloops, width
+    cpc r19,r15  ;  maxloops, width
+    breq .L13  ; ,   ;  52  branch  [length = 1]
+.L9:
+/*         if (++width == maxloops) */
+.LM7:
+    ld r24,Z   ;  D.1554, *port_7(D)   ;  60  movqi_insn/4  [length = 1]
+    and r24,r22  ;  D.1554, bit  ;  62  andqi3/1  [length = 1]
+    cp r24,r20   ;  D.1554, stateMask  ;  63  *cmpqi/2  [length = 1]
+    breq .L10  ; ,   ;  64  branch  [length = 1]
+/*             return 0;
+***     }
+***     return width;
+*/
+.LM8:
+    mov r22,r12  ;  D.1553, width  ;  108 movqi_insn/1  [length = 1]
+    mov r23,r13  ;  D.1553, width  ;  109 movqi_insn/1  [length = 1]
+    mov r24,r14  ;  D.1553, width  ;  110 movqi_insn/1  [length = 1]
+    mov r25,r15  ;  D.1553, width  ;  111 movqi_insn/1  [length = 1]
+/* epilogue start */
+.LM9:
+    pop r17  ;   ;  171 popqi [length = 1]
+    pop r16  ;   ;  172 popqi [length = 1]
+    pop r15  ;   ;  173 popqi [length = 1]
+    pop r14  ;   ;  174 popqi [length = 1]
+    pop r13  ;   ;  175 popqi [length = 1]
+    pop r12  ;   ;  176 popqi [length = 1]
+    ret  ;  177 return_from_epilogue  [length = 1]
+.L13:
+.LM10:
+    ldi r22,0  ;  D.1553   ;  120 movqi_insn/1  [length = 1]
+    ldi r23,0  ;  D.1553   ;  121 movqi_insn/1  [length = 1]
+    ldi r24,0  ;  D.1553   ;  122 movqi_insn/1  [length = 1]
+    ldi r25,0  ;  D.1553   ;  123 movqi_insn/1  [length = 1]
+/* epilogue start */
+.LM11:
+    pop r17  ;   ;  138 popqi [length = 1]
+    pop r16  ;   ;  139 popqi [length = 1]
+    pop r15  ;   ;  140 popqi [length = 1]
+    pop r14  ;   ;  141 popqi [length = 1]
+    pop r13  ;   ;  142 popqi [length = 1]
+    pop r12  ;   ;  143 popqi [length = 1]
+    ret  ;  144 return_from_epilogue  [length = 1]

cores/arduino/wiring_pulse.c

@@ -0,0 +1,93 @@
+/*
+  wiring_pulse.c - pulseIn() function
+  Part of Arduino - http://www.arduino.cc/
+
+  Copyright (c) 2005-2006 David A. Mellis
+
+  This library is free software; you can redistribute it and/or
+  modify it under the terms of the GNU Lesser General Public
+  License as published by the Free Software Foundation; either
+  version 2.1 of the License, or (at your option) any later version.
+
+  This library 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
+  Lesser General Public License for more details.
+
+  You should have received a copy of the GNU Lesser General
+  Public License along with this library; if not, write to the
+  Free Software Foundation, Inc., 59 Temple Place, Suite 330,
+  Boston, MA  02111-1307  USA
+*/
+
+#include "wiring_private.h"
+#include "pins_arduino.h"
+
+/* Measures the length (in microseconds) of a pulse on the pin; state is HIGH
+ * or LOW, the type of pulse to measure.  Works on pulses from 2-3 microseconds
+ * to 3 minutes in length, but must be called at least a few dozen microseconds
+ * before the start of the pulse.
+ *
+ * This function performs better with short pulses in noInterrupt() context
+ */
+unsigned long pulseIn(uint8_t pin, uint8_t state, unsigned long timeout)
+{
+	// cache the port and bit of the pin in order to speed up the
+	// pulse width measuring loop and achieve finer resolution.  calling
+	// digitalRead() instead yields much coarser resolution.
+	uint8_t bit = digitalPinToBitMask(pin);
+	uint8_t port = digitalPinToPort(pin);
+	uint8_t stateMask = (state ? bit : 0);
+
+	// convert the timeout from microseconds to a number of times through
+	// the initial loop; it takes approximately 16 clock cycles per iteration
+	unsigned long maxloops = microsecondsToClockCycles(timeout)/16;
+
+	unsigned long width = countPulseASM(portInputRegister(port), bit, stateMask, maxloops);
+
+	// prevent clockCyclesToMicroseconds to return bogus values if countPulseASM timed out
+	if (width)
+		return clockCyclesToMicroseconds(width * 16 + 16);
+	else
+		return 0;
+}
+
+/* Measures the length (in microseconds) of a pulse on the pin; state is HIGH
+ * or LOW, the type of pulse to measure.  Works on pulses from 2-3 microseconds
+ * to 3 minutes in length, but must be called at least a few dozen microseconds
+ * before the start of the pulse.
+ *
+ * ATTENTION:
+ * this function relies on micros() so cannot be used in noInterrupt() context
+ */
+unsigned long pulseInLong(uint8_t pin, uint8_t state, unsigned long timeout)
+{
+	// cache the port and bit of the pin in order to speed up the
+	// pulse width measuring loop and achieve finer resolution.  calling
+	// digitalRead() instead yields much coarser resolution.
+	uint8_t bit = digitalPinToBitMask(pin);
+	uint8_t port = digitalPinToPort(pin);
+	uint8_t stateMask = (state ? bit : 0);
+
+	unsigned long startMicros = micros();
+
+	// wait for any previous pulse to end
+	while ((*portInputRegister(port) & bit) == stateMask) {
+		if (micros() - startMicros > timeout)
+			return 0;
+	}
+
+	// wait for the pulse to start
+	while ((*portInputRegister(port) & bit) != stateMask) {
+		if (micros() - startMicros > timeout)
+			return 0;
+	}
+
+	unsigned long start = micros();
+	// wait for the pulse to stop
+	while ((*portInputRegister(port) & bit) == stateMask) {
+		if (micros() - startMicros > timeout)
+			return 0;
+	}
+	return micros() - start;
+}

cores/arduino/wiring_shift.c

@@ -0,0 +1,56 @@
+/*
+  wiring_shift.c - shiftOut() function
+  Part of Arduino - http://www.arduino.cc/
+
+  Copyright (c) 2005-2006 David A. Mellis
+
+  This library is free software; you can redistribute it and/or
+  modify it under the terms of the GNU Lesser General Public
+  License as published by the Free Software Foundation; either
+  version 2.1 of the License, or (at your option) any later version.
+
+  This library 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
+  Lesser General Public License for more details.
+
+  You should have received a copy of the GNU Lesser General
+  Public License along with this library; if not, write to the
+  Free Software Foundation, Inc., 59 Temple Place, Suite 330,
+  Boston, MA  02111-1307  USA
+*/
+
+#include "wiring_private.h"
+
+uint8_t shiftIn(uint8_t dataPin, uint8_t clockPin, uint8_t bitOrder) {
+	uint8_t value = 0;
+	uint8_t i;
+
+	for (i = 0; i < 8; ++i) {
+		digitalWrite(clockPin, HIGH);
+		if (bitOrder == LSBFIRST)
+			value |= digitalRead(dataPin) << i;
+		else
+			value |= digitalRead(dataPin) << (7 - i);
+		digitalWrite(clockPin, LOW);
+	}
+	return value;
+}
+
+void shiftOut(uint8_t dataPin, uint8_t clockPin, uint8_t bitOrder, uint8_t val)
+{
+	uint8_t i;
+
+	for (i = 0; i < 8; i++)  {
+		if (bitOrder == LSBFIRST) {
+			digitalWrite(dataPin, val & 1);
+			val >>= 1;
+		} else {	
+			digitalWrite(dataPin, (val & 128) != 0);
+			val <<= 1;
+		}
+			
+		digitalWrite(clockPin, HIGH);
+		digitalWrite(clockPin, LOW);		
+	}
+}

libraries/idiBusMaster/library.properties

@@ -0,0 +1,8 @@
+name=IdiBusMaster
+version=0.2.0
+author=OLIMP LLC <briver.stanislav@olimp-z.ru>
+maintainer=OLIMP LLC <briver.stanislav@olimp-z.ru>
+sentence=Microchip/Arduino library for interfacing with IdiBus devices.
+url=https://olimp-z.ru
+architectures=avr
+includes=IdiBusMaster.h

libraries/idiBusMaster/src/IDIBUS_1Wire.cpp

@@ -0,0 +1,157 @@
+#include "IDIBUS_1Wire.h"
+
+IdiBus_1Wire::IdiBus_1Wire (IdiBusSerialLine *SlaveLine, uint8_t SlaveAddress) : IdiBusSlave(SlaveLine, SlaveAddress)
+{
+	for (uint8_t I=0; I<IDIBUS_1Wire_CH_COUNT; I++)
+	{
+		this->CH[I].MMES_Error = 0;
+		this->CH[I].Temperature = 0;
+		//this->CH[I].STATUS.Enable = 0;
+	}
+}
+
+IdiBus_1Wire::IdiBus_1Wire () : IdiBusSlave()
+{
+	for (uint8_t I=0; I<IDIBUS_1Wire_CH_COUNT; I++)
+	{
+		this->CH[I].MMES_Error = 0;
+		this->CH[I].Temperature = 0;
+		//this->CH[I].STATUS.Enable = 0;
+	}
+}
+
+IDIBUS_1Wire_DATA_TYPE IdiBus_1Wire::getChData(uint8_t ChNum){
+	if ( ChNum < IDIBUS_1Wire_CH_COUNT ) { return this->CH[ChNum]; }
+	else								{ return this->CH[IDIBUS_1Wire_CH3_NUM]; }
+}
+
+void IdiBus_1Wire::changeAllAutomatiocConversionStates()
+{
+	IdiBusMMES MMES(this->Address);
+	MMES.DEV.NUM       = IDIBUS_1Wire_CNTRL_DEV;
+	MMES.DEV.ALLCH     = 1;
+	MMES.ComFunc       = 0x01;
+	uint8_t ChDataSize = 1;	
+	uint8_t RequestError = this->SendRequestMMES(&MMES);
+	if      ( RequestError != IDIER_NOPE )            { this->setAllChErr(RequestError); return; }
+	else if (MMES.RxDataLength < IDIBUS_1Wire_CH_COUNT) { this->setAllChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); return; }
+	else {
+		uint8_t ExpDataLength = IDIBUS_1Wire_CH_COUNT; // Errors
+		for (uint8_t I=0; I<IDIBUS_1Wire_CH_COUNT; I++) {  if ( MMES.RxData[I] == IDIER_NOPE ) { ExpDataLength = (uint16_t)(ExpDataLength + ChDataSize); }  }
+		if ( ExpDataLength != MMES.RxDataLength )     {  this->setAllChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); return;  }
+	}
+	uint8_t ErrorPos = 0;
+	uint8_t DataPos  = ErrorPos + IDIBUS_1Wire_CH_COUNT;
+	for (uint8_t I = 0; I < IDIBUS_1Wire_CH_COUNT; I++)
+	{
+		this->CH[I].MMES_Error = MMES.RxData[ErrorPos];
+		ErrorPos = (uint8_t)(ErrorPos + 1);
+	}
+}
+
+void IdiBus_1Wire::startAllOneShotConversions()
+{
+	IdiBusMMES MMES(this->Address);
+	MMES.DEV.NUM       = IDIBUS_1Wire_CNTRL_DEV;
+	MMES.DEV.ALLCH     = 1;
+	MMES.ComFunc       = 0x02;
+	uint8_t ChDataSize = 0;		
+	uint8_t RequestError = this->SendRequestMMES(&MMES);
+	if      ( RequestError != IDIER_NOPE )            { this->setAllChErr(RequestError); return; }
+	else if (MMES.RxDataLength < IDIBUS_1Wire_CH_COUNT) { this->setAllChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); return; }
+	else {
+		uint8_t ExpDataLength = IDIBUS_1Wire_CH_COUNT; // Errors
+		for (uint8_t I=0; I<IDIBUS_1Wire_CH_COUNT; I++) {  if ( MMES.RxData[I] == IDIER_NOPE ) { ExpDataLength = (uint16_t)(ExpDataLength + ChDataSize); }  }
+		if ( ExpDataLength != MMES.RxDataLength )     {  this->setAllChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); return;  }
+	}
+	uint8_t ErrorPos = 0;
+	uint8_t DataPos  = ErrorPos + IDIBUS_1Wire_CH_COUNT;
+	for (uint8_t I = 0; I < IDIBUS_1Wire_CH_COUNT; I++)
+	{
+		this->CH[I].MMES_Error = MMES.RxData[ErrorPos];
+		ErrorPos = (uint8_t)(ErrorPos + 1);
+	}
+}
+
+uint8_t IdiBus_1Wire::getTemperature(uint8_t ChNum)
+{
+	if (ChNum >= IDIBUS_1Wire_CH_COUNT) { return IDIERMST_INVALID_CHN_NUM; }
+	IdiBusMMES MMES(this->Address);
+	MMES.DEV.NUM	= IDIBUS_1Wire_CNTRL_DEV;
+	MMES.CHNL.NUM   = ChNum;
+	MMES.ComFunc    = 0x03;	//Get Value
+	uint8_t ChDataSize = 2;		//int16_t
+	uint8_t RequestError = this->SendRequestMMES(&MMES);
+	if      ( RequestError   != IDIER_NOPE )          { this->CH[ChNum].MMES_Error = RequestError;   }
+	else if ( MMES.RxDataLength == 1 )                { this->CH[ChNum].MMES_Error = MMES.RxData[0]; }
+	else if ( MMES.RxDataLength != (ChDataSize + 1) ) { this->CH[ChNum].MMES_Error = IDIERMST_INVALID_RX_REQUEST_FORMAT; }
+	else {
+		this->CH[ChNum].MMES_Error = MMES.RxData[0];
+		if ( this->CH[ChNum].MMES_Error == IDIER_NOPE )
+		{
+			this->CH[ChNum].Temperature = (int16_t) (	 ((int16_t)MMES.RxData[1]<<8) |
+												     ((int16_t)MMES.RxData[2]));
+		}
+	}
+	return this->CH[ChNum].MMES_Error;
+}
+
+void IdiBus_1Wire::getAllChTemperature(void)
+{
+	IdiBusMMES MMES(this->Address);
+	MMES.DEV.NUM       = IDIBUS_1Wire_CNTRL_DEV;
+	MMES.DEV.ALLCH     = 1;
+	MMES.ComFunc       = 0x03;
+	uint8_t ChDataSize = 2;		//int16_t
+	uint8_t RequestError = this->SendRequestMMES(&MMES);
+	if      ( RequestError != IDIER_NOPE )            { this->setAllChErr(RequestError); return; }
+	else if (MMES.RxDataLength < IDIBUS_1Wire_CH_COUNT) { this->setAllChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); return; }
+	else {
+		uint8_t ExpDataLength = IDIBUS_1Wire_CH_COUNT; // Errors
+		for (uint8_t I=0; I<IDIBUS_1Wire_CH_COUNT; I++) {  if ( MMES.RxData[I] == IDIER_NOPE ) { ExpDataLength = (uint16_t)(ExpDataLength + ChDataSize); }  }
+		if ( ExpDataLength != MMES.RxDataLength )     {  this->setAllChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); return;  }
+	}
+	uint8_t ErrorPos = 0;
+	uint8_t DataPos  = ErrorPos + IDIBUS_1Wire_CH_COUNT;
+	for (uint8_t I = 0; I < IDIBUS_1Wire_CH_COUNT; I++)
+	{
+		this->CH[I].MMES_Error = MMES.RxData[ErrorPos];
+		ErrorPos = (uint8_t)(ErrorPos + 1);
+		if ( this->CH[I].MMES_Error == IDIER_NOPE )
+		{
+			this->CH[I].Temperature = (uint16_t) (
+			(uint16_t)((uint16_t)MMES.RxData[DataPos] << 8)  |
+			(uint16_t)((uint16_t)MMES.RxData[DataPos+1])      );
+			DataPos  = (uint8_t)(DataPos  + ChDataSize);
+		}
+	}
+}
+
+void IdiBus_1Wire::setAllChErr(uint8_t ErrCode)
+{
+	for (uint8_t I=0; I<IDIBUS_1Wire_CH_COUNT; I++) { this->CH[I].MMES_Error = ErrCode; }
+}
+
+/*
+void IdiBus_1Wire::initAllChs(void)
+{
+	//uint8_t TxData[2];
+	//TxData[0] = (uint8_t)(CurrentLimit >> 8);
+	//TxData[1] = (uint8_t)(CurrentLimit);
+	IdiBusMMES MMES(this->Address);
+	MMES.DEV.NUM       = IDIBUS_1Wire_CNTRL_DEV;
+	MMES.DEV.ALLCH	   = 1;
+	MMES.ComFunc       = 0x01;
+	uint8_t RequestError = this->SendRequestMMES(&MMES);
+	if      ( RequestError != IDIER_NOPE )             { this->setAllChErr(RequestError); }
+	else if (MMES.RxDataLength != IDIBUS_1Wire_CH_COUNT) { this->setAllChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); }
+	else
+	{
+		for (uint8_t I = 0; I < IDIBUS_1Wire_CH_COUNT; I++)
+		{
+			this->CH[I].MMES_Error = MMES.RxData[I];
+			//if ( this->CH[I].MMES_Error == IDIER_NOPE )
+		}
+	}
+}
+*/

libraries/idiBusMaster/src/IDIBUS_1Wire.h

@@ -0,0 +1,51 @@
+#ifndef IDIBUS_1Wire_H_
+#define IDIBUS_1Wire_H_
+
+#include "IdiBusSlave.h"				//	Common slave defines
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+#define IDIBUS_CUSTDEF_ERCODE_OneWIRE_CHANNEL_SETTINGS_ERROR						100U
+#define IDIBUS_CUSTDEF_ERCODE_OneWIRE_CHANNEL_CRC_ERROR								101U
+#define IDIBUS_CUSTDEF_ERCODE_OneWIRE_CHANNEL_NO_DATA								102U
+#define IDIBUS_CUSTDEF_ERCODE_OneWIRE_CHANNEL_NO_SENSOR								103U
+#define IDIBUS_CUSTDEF_ERCODE_OneWIRE_CHANNEL_AUTOCONVERSION_ENABLED				105U	
+#define IDIBUS_CUSTDEF_ERCODE_OneWIRE_CHANNEL_ONESHOT_IN_PROGRESS					106U	
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+enum IDIBUS_1Wire_MODULE_DEVICES_LIST {	//	Describe devices on module
+	IDIBUS_1Wire_CNTRL_DEV = 0,			//	ADC device ID
+	IDIBUS_1Wire_DEVICES_NUMBER			//	Device count on module
+	};
+
+enum {									//	Describe channel configuration for device (1Wire)
+	IDIBUS_1Wire_CH0_NUM = 0,			//	Name for 1st channel
+	IDIBUS_1Wire_CH1_NUM,				//			 2nd ...
+	IDIBUS_1Wire_CH2_NUM,				//
+	IDIBUS_1Wire_CH3_NUM,				//
+	IDIBUS_1Wire_CH_COUNT,				// Module channel count
+	};
+
+typedef struct {
+	int16_t Temperature;		//	Last voltage
+	uint8_t MMES_Error;		//	Last error
+} IDIBUS_1Wire_DATA_TYPE;	//	Data structure for ADC channels
+
+class IdiBus_1Wire : public IdiBusSlave {									//	ADC module class
+	public:																	//	Public methods 
+ 		IdiBus_1Wire ( IdiBusSerialLine *SlaveLine, uint8_t SlaveAddress);		// Init object with specified bus line and addr
+		IdiBus_1Wire ();															// init without specified line and addr (default value line=NULL,addr=1)
+		 	
+		void	startAllOneShotConversions();
+		void	changeAllAutomatiocConversionStates();
+		uint8_t getTemperature(uint8_t ChNum);									// Sends MMES and gets Ch voltage (writes to CH structure and return error code)
+		void    getAllChTemperature(void);											// Sends MMES and gets all Ch voltages (writes to CH structure)
+			
+		//void    initAllChs(void);												// Inits all adc channels on module
+	
+		IDIBUS_1Wire_DATA_TYPE  getChData(uint8_t ChNum);						// Returns data structure for ADC channel
+	
+	protected :																// 'Private' methods and structures
+		IDIBUS_1Wire_DATA_TYPE  CH[IDIBUS_1Wire_CH_COUNT];						// Data structure array
+			
+		void    setAllChErr(uint8_t ErrCode);									// Set error code for all channels
+};
+
+#endif /* IDIBUS_41Wire_H_ */

libraries/idiBusMaster/src/IDIBUS_1xGen.cpp

@@ -0,0 +1,145 @@
+#include "IDIBUS_1xGen.h"
+
+IdiBus_1xGen::IdiBus_1xGen (IdiBusSerialLine *SlaveLine, uint8_t SlaveAddress) : IdiBusSlave(SlaveLine, SlaveAddress)
+{
+	TMP.MMES_Error = 0;
+	TMP.RXlen = 0;
+}
+
+IdiBus_1xGen::IdiBus_1xGen () : IdiBusSlave()
+{
+	TMP.MMES_Error = 0;
+	TMP.RXlen = 0;
+}
+
+IDIBUS_1xGEN_DATA_TYPE IdiBus_1xGen::getData(void)
+{
+	return this->TMP;
+}
+
+// setters
+void IdiBus_1xGen::setFirstModeTime (uint8_t FirstTime) {
+	first_mode_time = FirstTime;
+}
+
+void IdiBus_1xGen::setFirstModePWM (uint16_t FirstPWM) {
+	first_mode_pwm_value = FirstPWM;
+}
+
+void IdiBus_1xGen::setFirstModeF (uint32_t FirstF) {
+	first_mode_f = FirstF;
+}
+
+void IdiBus_1xGen::setFirstModeInvert (uint8_t FirstInvert) {
+	first_mode_invert = FirstInvert;
+}
+
+void IdiBus_1xGen::setSecondModeTime (uint8_t SecondTime) {
+	second_mode_time = SecondTime;
+}
+
+void IdiBus_1xGen::setSecondModePWM (uint16_t SecondPWM) {
+	second_mode_pwm_value = SecondPWM;
+}
+
+void IdiBus_1xGen::setSecondModeF (uint32_t SecondF) {
+	second_mode_f = SecondF;
+}
+
+void IdiBus_1xGen::setSecondModeInvert (uint8_t SecondInvert) {
+	second_mode_invert = SecondInvert;
+}
+
+// getters
+uint8_t IdiBus_1xGen::getFirstModeTime () {
+	return first_mode_time;
+}
+
+uint16_t IdiBus_1xGen::getFirstModePWM () {
+	return first_mode_pwm_value;
+}
+
+uint32_t IdiBus_1xGen::getFirstModeF () {
+	return first_mode_f;
+}
+
+uint8_t IdiBus_1xGen::getFirstModeInvert () {
+	return first_mode_invert;
+}
+
+uint8_t IdiBus_1xGen::getSecondModeTime () {
+	return second_mode_time;
+}
+
+uint16_t IdiBus_1xGen::getSecondModePWM () {
+	return second_mode_pwm_value;
+}
+
+uint32_t IdiBus_1xGen::getSecondModeF () {
+	return second_mode_f;
+}
+
+uint8_t IdiBus_1xGen::getSecondModeInvert () {
+	return second_mode_invert;
+}
+
+uint8_t IdiBus_1xGen::startGen(void) {
+	//uint8_t buf[10] = {this->first_mode_time,
+		//(uint8_t)((this->first_mode_pwm_value >> 8) & 0xFF), (uint8_t)(this->first_mode_pwm_value & 0xFF),
+		//this->first_mode_f, this->first_mode_invert,
+		//this->second_mode_time,
+		//(uint8_t)((this->second_mode_pwm_value >> 8) & 0xFF), (uint8_t)(this->second_mode_pwm_value & 0xFF),
+	//this->second_mode_f, this->second_mode_invert};
+	
+	uint8_t buf[16] = {this->first_mode_time,
+	(uint8_t)((this->first_mode_pwm_value >> 8) & 0xFF), (uint8_t)(this->first_mode_pwm_value & 0xFF),
+
+	(uint8_t)((this->first_mode_f >> 24) & 0xFF), 
+	(uint8_t)((this->first_mode_f >> 16) & 0xFF),
+	(uint8_t)((this->first_mode_f >> 8) & 0xFF),
+	(uint8_t)(this->first_mode_f & 0xFF),
+	
+	this->first_mode_invert,
+	//
+	this->second_mode_time,
+	(uint8_t)((this->second_mode_pwm_value >> 8) & 0xFF), (uint8_t)(this->second_mode_pwm_value & 0xFF),
+	
+	(uint8_t)((this->second_mode_f >> 24) & 0xFF),
+	(uint8_t)((this->second_mode_f >> 16) & 0xFF),
+	(uint8_t)((this->second_mode_f >> 8) & 0xFF),
+	(uint8_t)(this->second_mode_f & 0xFF),
+	
+	this->second_mode_invert};
+	
+	IdiBusMMES MMES(this->Address);
+	MMES.DEV.NUM	= IDIBUS_1xGen_DEV;
+	MMES.CHNL.NUM   = 0;
+	MMES.ComFunc    = 0x01;
+	MMES.TxDataLength = 16;
+	MMES.TxData = buf;
+	uint8_t RequestError = this->SendRequestMMES(&MMES);
+	
+	if      ( RequestError   != IDIER_NOPE )          { this->TMP.MMES_Error = RequestError;   }
+	else if ( MMES.RxDataLength == 1 )                { this->TMP.MMES_Error = MMES.RxData[0]; }
+	else {
+		this->TMP.MMES_Error = IDIERMST_INVALID_RX_REQUEST_FORMAT;
+	}
+	return this->TMP.MMES_Error;
+}
+
+uint8_t IdiBus_1xGen::resetGen() {
+	IdiBusMMES MMES(this->Address);
+	MMES.DEV.NUM	= IDIBUS_1xGen_DEV;
+	MMES.CHNL.NUM   = 0;
+	MMES.ComFunc    = 0x02;
+	
+	uint8_t ChDataSize = 0;
+	uint8_t RequestError = this->SendRequestMMES(&MMES);
+	
+	if      ( RequestError   != IDIER_NOPE )          { this->TMP.MMES_Error = RequestError;   }
+	else if ( MMES.RxDataLength == 1 )                { this->TMP.MMES_Error = MMES.RxData[0]; }
+	else {
+		this->TMP.MMES_Error = IDIERMST_INVALID_RX_REQUEST_FORMAT;
+	}
+	return this->TMP.MMES_Error;
+}

libraries/idiBusMaster/src/IDIBUS_1xGen.h

@@ -0,0 +1,62 @@
+#ifndef IDIBUS_1XGEN_H_
+#define IDIBUS_1XGEN_H_
+
+#include "IdiBusSlave.h"
+
+enum IDIBUS_1xGen_MODULE_DEVICES_LIST {
+	IDIBUS_1xGen_DEV = 0x00,
+	IDIBUS_1xGen_DEVICES_NUMBER
+};
+
+typedef struct {
+	uint8_t RXlen;
+	uint8_t RXbuf[255];
+	uint8_t MMES_Error;  //	Last error
+} IDIBUS_1xGEN_DATA_TYPE;
+
+class IdiBus_1xGen : public IdiBusSlave {
+	public:
+		IdiBus_1xGen(IdiBusSerialLine *SlaveLine, uint8_t SlaveAddress);
+		IdiBus_1xGen();
+		
+		uint8_t startGen();
+		uint8_t resetGen();
+		
+		IDIBUS_1xGEN_DATA_TYPE getData();
+		
+		void setFirstModeTime (uint8_t FirstTime);
+		void setFirstModePWM (uint16_t FirstPWM);
+		void setFirstModeF (uint32_t FirstF);
+		void setFirstModeInvert (uint8_t FirstInvert);
+		
+		void setSecondModeTime (uint8_t SecondTime);
+		void setSecondModePWM (uint16_t SecondPWM);
+		void setSecondModeF (uint32_t SecondF);
+		void setSecondModeInvert (uint8_t SecondInvert);
+		
+		uint8_t getFirstModeTime ();
+		uint16_t getFirstModePWM ();
+		uint32_t getFirstModeF ();
+		uint8_t getFirstModeInvert ();
+		
+		uint8_t getSecondModeTime ();
+		uint16_t getSecondModePWM ();
+		uint32_t getSecondModeF ();
+		uint8_t getSecondModeInvert ();
+
+	protected:
+		IDIBUS_1xGEN_DATA_TYPE TMP;
+		
+	private:
+		uint8_t first_mode_time;
+		uint16_t first_mode_pwm_value;
+		uint32_t first_mode_f;
+		uint8_t first_mode_invert;
+		
+		uint8_t second_mode_time;
+		uint16_t second_mode_pwm_value;
+		uint32_t second_mode_f;
+		uint8_t second_mode_invert;
+};
+
+#endif /* IDIBUS_1XGEN_H_ */

libraries/idiBusMaster/src/IDIBUS_2SALTMETER.cpp

@@ -0,0 +1,160 @@
+#include "IDIBUS_2SALTMETER.h"
+
+IdiBus_2SALT::IdiBus_2SALT (IdiBusSerialLine *SlaveLine, uint8_t SlaveAddress) : IdiBusSlave(SlaveLine, SlaveAddress)
+{
+	for (uint8_t I=0; I<IDIBUS_2SALT_CH_COUNT; I++)
+	{
+		this->CH[I].MMES_Error = 0;
+		this->CH[I].Voltage = 0;
+	}
+}
+
+IdiBus_2SALT::IdiBus_2SALT () : IdiBusSlave()
+{
+	for (uint8_t I=0; I<IDIBUS_2SALT_CH_COUNT; I++)
+	{
+		this->CH[I].MMES_Error = 0;
+		this->CH[I].Voltage = 0;
+	}
+}
+
+IDIBUS_2SALT_DATA_TYPE IdiBus_2SALT::getChData(uint8_t ChNum){
+	if ( ChNum < IDIBUS_2SALT_CH_COUNT ) { return this->CH[ChNum]; }
+	else								{ return this->CH[IDIBUS_2SALT_CH1_NUM]; }
+}
+
+uint8_t IdiBus_2SALT::getChSaltData(uint8_t ChNum)
+{
+	if (ChNum >= IDIBUS_2SALT_CH_COUNT) { return IDIERMST_INVALID_CHN_NUM; }
+	IdiBusMMES MMES(this->Address);
+	MMES.DEV.NUM	= IDIBUS_2SALT_CNTRL_DEV;
+	MMES.CHNL.NUM   = ChNum;
+	MMES.ComFunc    = 0x03;		//Get Value
+	uint8_t ChDataSize = 2;		//uint16_t
+	uint8_t RequestError = this->SendRequestMMES(&MMES);
+	if      ( RequestError   != IDIER_NOPE )          { this->CH[ChNum].MMES_Error = RequestError;   }
+	else if ( MMES.RxDataLength == 1 )                { this->CH[ChNum].MMES_Error = MMES.RxData[0]; }
+	else if ( MMES.RxDataLength != (ChDataSize + 1) ) { this->CH[ChNum].MMES_Error = IDIERMST_INVALID_RX_REQUEST_FORMAT; }
+	else {
+		this->CH[ChNum].MMES_Error = MMES.RxData[0];
+		if ( this->CH[ChNum].MMES_Error == IDIER_NOPE )
+		{
+			this->CH[ChNum].Voltage = (uint16_t) (
+			((uint16_t)MMES.RxData[1]     << 8 )  |
+			((uint16_t)MMES.RxData[2])			);
+		}
+	}
+	return this->CH[ChNum].MMES_Error;
+
+}
+
+void IdiBus_2SALT::getAllChsSaltData(void)
+{
+	IdiBusMMES MMES(this->Address);
+	MMES.DEV.NUM       = IDIBUS_2SALT_CNTRL_DEV;
+	MMES.DEV.ALLCH     = 1;
+	MMES.ComFunc       = 0x03;
+	uint8_t ChDataSize = 2;		//uint16_t
+	uint8_t RequestError = this->SendRequestMMES(&MMES);
+	if      ( RequestError != IDIER_NOPE )            { this->setAllChErr(RequestError); return; }
+	else if (MMES.RxDataLength < IDIBUS_2SALT_CH_COUNT) { this->setAllChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); return; }
+	else {
+		uint8_t ExpDataLength = IDIBUS_2SALT_CH_COUNT; // Errors
+		for (uint8_t I=0; I<IDIBUS_2SALT_CH_COUNT; I++) {  if ( MMES.RxData[I] == IDIER_NOPE ) { ExpDataLength = (uint16_t)(ExpDataLength + ChDataSize); }  }
+		if ( ExpDataLength != MMES.RxDataLength )     {  this->setAllChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); return;  }
+	}
+	uint8_t ErrorPos = 0;
+	uint8_t DataPos  = ErrorPos + IDIBUS_2SALT_CH_COUNT;
+	for (uint8_t I = 0; I < IDIBUS_2SALT_CH_COUNT; I++)
+	{
+		this->CH[I].MMES_Error = MMES.RxData[ErrorPos];
+		ErrorPos = (uint8_t)(ErrorPos + 1);
+		if ( this->CH[I].MMES_Error == IDIER_NOPE ) {
+			this->CH[I].Voltage = (uint16_t) (
+			((uint16_t)MMES.RxData[DataPos]	  << 8)  |
+			((uint16_t)MMES.RxData[DataPos+1]) );
+			DataPos  = (uint8_t)(DataPos  + ChDataSize);
+		}
+	}
+}
+
+void IdiBus_2SALT::setAllChErr(uint8_t ErrCode)
+{
+	for (uint8_t I=0; I<IDIBUS_2SALT_CH_COUNT; I++) { this->CH[I].MMES_Error = ErrCode; }
+}
+
+uint8_t IdiBus_2SALT::setCh(uint8_t ChNum, uint8_t state)
+{
+	if (ChNum >= IDIBUS_2SALT_CH_COUNT) { return IDIERMST_INVALID_CHN_NUM; }
+	IdiBusMMES MMES(this->Address);
+	MMES.DEV.NUM       = IDIBUS_2SALT_CNTRL_DEV;
+	MMES.CHNL.NUM	   = ChNum;
+	MMES.ComFunc       = 0x01; //init
+	MMES.TxDataLength  = 1; 
+	MMES.TxData = &state;
+	uint8_t RequestError = this->SendRequestMMES(&MMES);
+	if      ( RequestError   != IDIER_NOPE )          { this->CH[ChNum].MMES_Error = RequestError;   }
+	else if ( MMES.RxDataLength != 1 )                { this->CH[ChNum].MMES_Error = IDIERMST_INVALID_RX_REQUEST_FORMAT; }
+	else {
+		this->CH[ChNum].MMES_Error = MMES.RxData[0];
+	}
+	return this->CH[ChNum].MMES_Error;
+
+}
+
+void IdiBus_2SALT::setAllCh(uint8_t state)
+{
+	IdiBusMMES MMES(this->Address);
+	MMES.DEV.NUM       = IDIBUS_2SALT_CNTRL_DEV;
+	MMES.DEV.ALLCH	   = 1;
+	MMES.ComFunc       = 0x01;	//init
+	MMES.TxDataLength  = 1; 
+	MMES.TxData = &state;
+	MMES.CHNL.ALLSAME = 1;
+	uint8_t RequestError = this->SendRequestMMES(&MMES);
+	if      ( RequestError != IDIER_NOPE )             { this->setAllChErr(RequestError); }
+	else if (MMES.RxDataLength != IDIBUS_2SALT_CH_COUNT) { this->setAllChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); }
+	else
+	{
+		for (uint8_t I = 0; I < IDIBUS_2SALT_CH_COUNT; I++)
+		{
+			this->CH[I].MMES_Error = MMES.RxData[I];
+		}
+	}
+}
+
+uint8_t IdiBus_2SALT::startOneShot(uint8_t ChNum)
+{
+	if (ChNum >= IDIBUS_2SALT_CH_COUNT) { return IDIERMST_INVALID_CHN_NUM; }
+	IdiBusMMES MMES(this->Address);
+	MMES.DEV.NUM       = IDIBUS_2SALT_CNTRL_DEV;
+	MMES.CHNL.NUM	   = ChNum;
+	MMES.ComFunc       = 0x02; //init
+	uint8_t RequestError = this->SendRequestMMES(&MMES);
+	if      ( RequestError   != IDIER_NOPE )          { this->CH[ChNum].MMES_Error = RequestError;   }
+	else if ( MMES.RxDataLength != 1 )                { this->CH[ChNum].MMES_Error = IDIERMST_INVALID_RX_REQUEST_FORMAT; }
+	else {
+		this->CH[ChNum].MMES_Error = MMES.RxData[0];
+	}
+	return this->CH[ChNum].MMES_Error;
+
+}
+
+void IdiBus_2SALT::startAllOneShot(void)
+{
+	IdiBusMMES MMES(this->Address);
+	MMES.DEV.NUM       = IDIBUS_2SALT_CNTRL_DEV;
+	MMES.DEV.ALLCH	   = 1;
+	MMES.ComFunc       = 0x02;	//init
+	uint8_t RequestError = this->SendRequestMMES(&MMES);
+	if      ( RequestError != IDIER_NOPE )             { this->setAllChErr(RequestError); }
+	else if (MMES.RxDataLength != IDIBUS_2SALT_CH_COUNT) { this->setAllChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); }
+	else
+	{
+		for (uint8_t I = 0; I < IDIBUS_2SALT_CH_COUNT; I++)
+		{
+			this->CH[I].MMES_Error = MMES.RxData[I];
+		}
+	}
+}
+

libraries/idiBusMaster/src/IDIBUS_2SALTMETER.h

@@ -0,0 +1,51 @@
+#ifndef IDIBUS_2SALT_H_
+#define IDIBUS_2SALT_H_
+
+#include "IdiBusSlave.h"				//	Common slave defines
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+#define IDIBUS_CUSTDEF_ERCODE_SALTMETER_POWEROFF								100U
+#define IDIBUS_CUSTDEF_ERCODE_SALTMETER_CHANNEL_CAPTURE_IN_PROGRESS				101U
+#define IDIBUS_CUSTDEF_ERCODE_SALTMETER_CHANNEL_NOT_SELECTED					102U
+#define IDIBUS_CUSTDEF_ERCODE_SALTMETER_CHANNEL_NO_VALID_DATA					103U
+#define IDIBUS_CUSTDEF_ERCODE_SALTMETER_CHANNEL_NO_STABLE_DATA					104U
+#define IDIBUS_CUSTDEF_ERCODE_SALTMETER_TWI_ERROR								106U
+#define IDIBUS_CUSTDEF_ERCODE_SALTMETER_TWI_BUSY								107U
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+enum IDIBUS_2SALT_MODULE_DEVICES_LIST {	//	Describe devices on module
+	IDIBUS_2SALT_CNTRL_DEV = 0,			//	SALT device ID
+	IDIBUS_2SALT_DEVICES_NUMBER			//	Device count on module	
+	};
+
+enum {									// Describe channel configuration for device (SALT)	
+	IDIBUS_2SALT_CH0_NUM = 0,			// Name for 1st channel
+	IDIBUS_2SALT_CH1_NUM,				//			2nd ...
+	IDIBUS_2SALT_CH_COUNT,				// Channel count
+	};
+
+typedef struct {
+	uint16_t Voltage;					// Last returned value
+	uint8_t MMES_Error;					// Last error
+} IDIBUS_2SALT_DATA_TYPE;				// Data structure for SALT channels
+
+class IdiBus_2SALT : public IdiBusSlave {									//	SALT module class
+	public:																	//	Public methods
+ 		IdiBus_2SALT ( IdiBusSerialLine *SlaveLine, uint8_t SlaveAddress);		// Init object with specified bus line and addr 
+		IdiBus_2SALT();															// init without specified line and addr (default value line=NULL,addr=1)
+		 
+		uint8_t getChSaltData(uint8_t ChNum);										//	Sends MMES and get Counts on ch (writes to CH structure and returns MMES error code)
+		void    getAllChsSaltData(void);											//	Sends MMES and get Counts on ch (writes to CH structure)
+
+		uint8_t startOneShot(uint8_t ChNum);
+		void	startAllOneShot(void);
+		
+		uint8_t setCh(uint8_t ChNum, uint8_t state);							// Inits specified counter channel on module
+		void    setAllCh(uint8_t state);										// Inits all counters on module
+
+		IDIBUS_2SALT_DATA_TYPE  getChData(uint8_t ChNum);						// Returns data structure
+	
+	protected:																// 'Private' methods and structures			
+		IDIBUS_2SALT_DATA_TYPE  CH[IDIBUS_2SALT_CH_COUNT];						// Data structure array
+		
+		void    setAllChErr(uint8_t ErrCode);									// Set error code for all channels
+};
+#endif

libraries/idiBusMaster/src/IDIBUS_3Thermo1HT.cpp

@@ -0,0 +1,250 @@
+#include "IDIBUS_3Thermo1HT.h"
+
+IdiBusDevice *IdiBus_3Thermo1HT::getDevice(uint8_t Num)
+{
+ switch (Num)
+	{
+	 case ( IDIBUS_3Thermo1HT_THERMO_DEV ) :  { return &this->THERMO_DEV; }
+	 //case ( IDIBUS_INPV_CNTRL_DEV ) : { return &this->INPV_DEV; }
+	 default :                        { return NULL; }
+	}
+}
+
+IdiBus_3Thermo1HT_ThermoChannel::IdiBus_3Thermo1HT_ThermoChannel(void) : IdiBusChannel()
+{ 
+ this->Temperature = 0;
+ this->CJTemperature = 0;
+ this->MMES_Error = (1<<2);
+ /*Bit error list
+	0 - Sensor fault
+	1 - over/under voltage
+	2 - no data error
+	6 - TC out of range
+	7 - CJ out of range
+	*/
+}
+
+IdiBusChannel *IdiBus_3Thermo1HT_ThermoDevice::getChannel(uint8_t Num)
+{
+ if ( Num < IDIBUS_3Thermo1HT_Thermo_CH_COUNT ) { return &this->CH[Num]; }
+ else                             { return NULL; }
+}
+
+IdiBus_3Thermo1HT_ThermoChannel IdiBus_3Thermo1HT_ThermoDevice::getChData(uint8_t ChNum){
+	if ( ChNum < IDIBUS_3Thermo1HT_Thermo_CH_COUNT ) { return this->CH[ChNum]; }
+	else								{ IdiBus_3Thermo1HT_ThermoChannel NewData; return NewData; }
+}
+
+uint8_t IdiBus_3Thermo1HT_ThermoDevice::startOneShotConversion(uint8_t ChNum)
+{
+	if (ChNum >= IDIBUS_3Thermo1HT_Thermo_CH_COUNT) { return IDIERMST_INVALID_CHN_NUM; }
+		
+	IdiBusMMES MMES(static_cast<IdiBusSlave*>(this->Module)->getAddress());
+	MMES.DEV.NUM	= IDIBUS_3Thermo1HT_THERMO_DEV;
+	MMES.CHNL.NUM   = ChNum;
+	MMES.ComFunc    = 0x02;	//Start one shot conversion 
+	
+	uint8_t ChDataSize = 0;	//None
+	uint8_t RequestError = static_cast<IdiBusSlave*>(this->Module)->SendRequestMMES(&MMES);
+	
+	if      ( RequestError   != IDIER_NOPE )          { this->CH[ChNum].MMES_Error = RequestError;   }
+	else if ( MMES.RxDataLength == 1 )                { this->CH[ChNum].MMES_Error = MMES.RxData[0]; }
+	else if ( MMES.RxDataLength != (ChDataSize + 1) ) { this->CH[ChNum].MMES_Error = IDIERMST_INVALID_RX_REQUEST_FORMAT; }
+	else {
+		this->CH[ChNum].MMES_Error = MMES.RxData[0];
+	}
+	return this->CH[ChNum].MMES_Error;
+} //
+
+void IdiBus_3Thermo1HT_ThermoDevice::startAllOneShotConversions()
+{
+	IdiBusMMES MMES(static_cast<IdiBusSlave*>(this->Module)->getAddress());
+	MMES.DEV.NUM	= IDIBUS_3Thermo1HT_THERMO_DEV;
+	MMES.DEV.ALLCH     = 1;
+	MMES.ComFunc       = 0x02;//Set automatic conversion
+	uint8_t ChDataSize = 0;		//None
+	uint8_t RequestError = static_cast<IdiBusSlave*>(this->Module)->SendRequestMMES(&MMES);
+	if      ( RequestError != IDIER_NOPE )            { this->setAllChErr(RequestError); return; }
+	else if (MMES.RxDataLength < IDIBUS_3Thermo1HT_Thermo_CH_COUNT) { this->setAllChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); return; }
+	else {
+		uint8_t ExpDataLength = IDIBUS_3Thermo1HT_Thermo_CH_COUNT; // Errors
+		for (uint8_t I=0; I<IDIBUS_3Thermo1HT_Thermo_CH_COUNT; I++) {  if ( MMES.RxData[I] == IDIER_NOPE ) { ExpDataLength = (uint16_t)(ExpDataLength + ChDataSize); }  }
+		if ( ExpDataLength != MMES.RxDataLength )     {  this->setAllChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); return;  }
+	}
+	uint8_t ErrorPos = 0;
+	uint8_t DataPos  = ErrorPos + IDIBUS_3Thermo1HT_Thermo_CH_COUNT;
+	for (uint8_t I = 0; I < IDIBUS_3Thermo1HT_Thermo_CH_COUNT; I++)
+	{
+		this->CH[I].MMES_Error = MMES.RxData[ErrorPos];
+		ErrorPos = (uint8_t)(ErrorPos + 1);
+	}
+}
+
+uint8_t IdiBus_3Thermo1HT_ThermoDevice::changeAutomatiocConversionState(uint8_t ChNum)
+{
+	if (ChNum >= IDIBUS_3Thermo1HT_Thermo_CH_COUNT) { return IDIERMST_INVALID_CHN_NUM; }
+		
+	IdiBusMMES MMES(static_cast<IdiBusSlave*>(this->Module)->getAddress());
+	MMES.DEV.NUM	= IDIBUS_3Thermo1HT_THERMO_DEV;
+	MMES.CHNL.NUM   = ChNum;
+	MMES.ComFunc    = 0x01;	//Set automatic conversion
+	
+	uint8_t ChDataSize = 1;	//uint8_t
+	uint8_t RequestError = static_cast<IdiBusSlave*>(this->Module)->SendRequestMMES(&MMES);
+	
+	if      ( RequestError   != IDIER_NOPE )          { this->CH[ChNum].MMES_Error = RequestError;   }
+	else if ( MMES.RxDataLength == 1 )                { this->CH[ChNum].MMES_Error = MMES.RxData[0]; }
+	else if ( MMES.RxDataLength != (ChDataSize + 1) ) { this->CH[ChNum].MMES_Error = IDIERMST_INVALID_RX_REQUEST_FORMAT; }
+	else {
+		this->CH[ChNum].MMES_Error = MMES.RxData[0];
+		//if ( this->CH[ChNum].MMES_Error == IDIER_NOPE )
+		//{
+			//Ignoring return value
+		//}
+	}
+	return this->CH[ChNum].MMES_Error;
+
+}
+
+void IdiBus_3Thermo1HT_ThermoDevice::changeAllAutomatiocConversionStates(void)
+{
+	IdiBusMMES MMES(static_cast<IdiBusSlave*>(this->Module)->getAddress());
+	MMES.DEV.NUM	= IDIBUS_3Thermo1HT_THERMO_DEV;
+	MMES.DEV.ALLCH     = 1;
+	MMES.ComFunc       = 0x01;//Set automatic conversion
+	uint8_t ChDataSize = 1;		//uint8_t
+	uint8_t RequestError = static_cast<IdiBusSlave*>(this->Module)->SendRequestMMES(&MMES);
+	if      ( RequestError != IDIER_NOPE )            { this->setAllChErr(RequestError); return; }
+	else if (MMES.RxDataLength < IDIBUS_3Thermo1HT_Thermo_CH_COUNT) { this->setAllChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); return; }
+	else {
+		uint8_t ExpDataLength = IDIBUS_3Thermo1HT_Thermo_CH_COUNT; // Errors
+		for (uint8_t I=0; I<IDIBUS_3Thermo1HT_Thermo_CH_COUNT; I++) {  if ( MMES.RxData[I] == IDIER_NOPE ) { ExpDataLength = (uint16_t)(ExpDataLength + ChDataSize); }  }
+		if ( ExpDataLength != MMES.RxDataLength )     {  this->setAllChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); return;  }
+	}
+	uint8_t ErrorPos = 0;
+	uint8_t DataPos  = ErrorPos + IDIBUS_3Thermo1HT_Thermo_CH_COUNT;
+	for (uint8_t I = 0; I < IDIBUS_3Thermo1HT_Thermo_CH_COUNT; I++)
+	{
+		this->CH[I].MMES_Error = MMES.RxData[ErrorPos];
+		ErrorPos = (uint8_t)(ErrorPos + 1);
+		//if ( this->CH[I].MMES_Error == IDIER_NOPE )
+		//{
+		//}
+	}
+
+}
+
+uint8_t IdiBus_3Thermo1HT_ThermoDevice::getTemperature(uint8_t ChNum)
+{
+	if (ChNum >= IDIBUS_3Thermo1HT_Thermo_CH_COUNT) { return IDIERMST_INVALID_CHN_NUM; }
+	IdiBusMMES MMES(static_cast<IdiBusSlave*>(this->Module)->getAddress());
+	MMES.DEV.NUM	= IDIBUS_3Thermo1HT_THERMO_DEV;
+	MMES.CHNL.NUM   = ChNum;
+	MMES.ComFunc    = 0x03;	//Get Value
+	uint8_t ChDataSize = 3;	//int24_t
+	uint8_t RequestError = static_cast<IdiBusSlave*>(this->Module)->SendRequestMMES(&MMES);
+	if      ( RequestError   != IDIER_NOPE )          { this->CH[ChNum].MMES_Error = RequestError;   }
+	else if ( MMES.RxDataLength == 1 )                { this->CH[ChNum].MMES_Error = MMES.RxData[0]; }
+	else if ( MMES.RxDataLength != (ChDataSize + 1) ) { this->CH[ChNum].MMES_Error = IDIERMST_INVALID_RX_REQUEST_FORMAT; }
+	else {
+		this->CH[ChNum].MMES_Error = MMES.RxData[0];
+		if ( this->CH[ChNum].MMES_Error == IDIER_NOPE )
+		{
+			this->CH[ChNum].Temperature = (int32_t) (	((int32_t)MMES.RxData[1]<<16) |
+														((int32_t)MMES.RxData[2]<<8) |
+														((int32_t)MMES.RxData[3]));
+		}
+	}
+	return this->CH[ChNum].MMES_Error;
+
+}
+
+void IdiBus_3Thermo1HT_ThermoDevice::getAllChTemperature(void)
+{
+	IdiBusMMES MMES(static_cast<IdiBusSlave*>(this->Module)->getAddress());
+	MMES.DEV.NUM	= IDIBUS_3Thermo1HT_THERMO_DEV;
+	MMES.DEV.ALLCH     = 1;
+	MMES.ComFunc       = 0x03;
+	uint8_t ChDataSize = 3;		//int24_t
+	uint8_t RequestError = static_cast<IdiBusSlave*>(this->Module)->SendRequestMMES(&MMES);
+	if      ( RequestError != IDIER_NOPE )            { this->setAllChErr(RequestError); return; }
+	else if (MMES.RxDataLength < IDIBUS_3Thermo1HT_Thermo_CH_COUNT) { this->setAllChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); return; }
+	else {
+		uint8_t ExpDataLength = IDIBUS_3Thermo1HT_Thermo_CH_COUNT; // Errors
+		for (uint8_t I=0; I<IDIBUS_3Thermo1HT_Thermo_CH_COUNT; I++) {  if ( MMES.RxData[I] == IDIER_NOPE ) { ExpDataLength = (uint16_t)(ExpDataLength + ChDataSize); }  }
+		if ( ExpDataLength != MMES.RxDataLength )     {  this->setAllChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); return;  }
+	}
+	uint8_t ErrorPos = 0;
+	uint8_t DataPos  = ErrorPos + IDIBUS_3Thermo1HT_Thermo_CH_COUNT;
+	for (uint8_t I = 0; I < IDIBUS_3Thermo1HT_Thermo_CH_COUNT; I++)
+	{
+		this->CH[I].MMES_Error = MMES.RxData[ErrorPos];
+		ErrorPos = (uint8_t)(ErrorPos + 1);
+		if ( this->CH[I].MMES_Error == IDIER_NOPE )
+		{
+			this->CH[I].Temperature = (int32_t) (	((int32_t)MMES.RxData[DataPos]<<16) |
+														((int32_t)MMES.RxData[DataPos+1]<<8) |
+														((int32_t)MMES.RxData[DataPos+2]));
+			DataPos  = (uint8_t)(DataPos  + ChDataSize);
+		}
+	}
+}
+
+uint8_t IdiBus_3Thermo1HT_ThermoDevice::getCJTemperature(uint8_t ChNum)
+{
+	if (ChNum >= IDIBUS_3Thermo1HT_Thermo_CH_COUNT) { return IDIERMST_INVALID_CHN_NUM; }
+	IdiBusMMES MMES(static_cast<IdiBusSlave*>(this->Module)->getAddress());
+	MMES.DEV.NUM	= IDIBUS_3Thermo1HT_THERMO_DEV;
+	MMES.CHNL.NUM   = ChNum;
+	MMES.ComFunc    = 0x04;	//Get Value
+	uint8_t ChDataSize = 2;	//int16_t
+	uint8_t RequestError = static_cast<IdiBusSlave*>(this->Module)->SendRequestMMES(&MMES);
+	if      ( RequestError   != IDIER_NOPE )          { this->CH[ChNum].MMES_Error = RequestError;   }
+	else if ( MMES.RxDataLength == 1 )                { this->CH[ChNum].MMES_Error = MMES.RxData[0]; }
+	else if ( MMES.RxDataLength != (ChDataSize + 1) ) { this->CH[ChNum].MMES_Error = IDIERMST_INVALID_RX_REQUEST_FORMAT; }
+	else {
+		this->CH[ChNum].MMES_Error = MMES.RxData[0];
+		if ( this->CH[ChNum].MMES_Error == IDIER_NOPE )
+		{
+			this->CH[ChNum].Temperature = (int16_t) (	((int16_t)MMES.RxData[1]<<8) |
+														((int16_t)MMES.RxData[2]) );
+		}
+	}
+	return this->CH[ChNum].MMES_Error;
+
+}
+
+void IdiBus_3Thermo1HT_ThermoDevice::getAllChCJTemperature(void)
+{
+	IdiBusMMES MMES(static_cast<IdiBusSlave*>(this->Module)->getAddress());
+	MMES.DEV.NUM	= IDIBUS_3Thermo1HT_THERMO_DEV;
+	MMES.DEV.ALLCH     = 1;
+	MMES.ComFunc       = 0x04;
+	uint8_t ChDataSize = 2;		//int24_t
+	uint8_t RequestError = static_cast<IdiBusSlave*>(this->Module)->SendRequestMMES(&MMES);
+	if      ( RequestError != IDIER_NOPE )            { this->setAllChErr(RequestError); return; }
+	else if (MMES.RxDataLength < IDIBUS_3Thermo1HT_Thermo_CH_COUNT) { this->setAllChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); return; }
+	else {
+		uint8_t ExpDataLength = IDIBUS_3Thermo1HT_Thermo_CH_COUNT; // Errors
+		for (uint8_t I=0; I<IDIBUS_3Thermo1HT_Thermo_CH_COUNT; I++) {  if ( MMES.RxData[I] == IDIER_NOPE ) { ExpDataLength = (uint16_t)(ExpDataLength + ChDataSize); }  }
+		if ( ExpDataLength != MMES.RxDataLength )     {  this->setAllChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); return;  }
+	}
+	uint8_t ErrorPos = 0;
+	uint8_t DataPos  = ErrorPos + IDIBUS_3Thermo1HT_Thermo_CH_COUNT;
+	for (uint8_t I = 0; I < IDIBUS_3Thermo1HT_Thermo_CH_COUNT; I++)
+	{
+		this->CH[I].MMES_Error = MMES.RxData[ErrorPos];
+		ErrorPos = (uint8_t)(ErrorPos + 1);
+		if ( this->CH[I].MMES_Error == IDIER_NOPE )
+		{
+			this->CH[I].Temperature = (int16_t) (	((int16_t)MMES.RxData[DataPos]<<8) |
+														((int16_t)MMES.RxData[DataPos+1])  ); 
+			DataPos  = (uint8_t)(DataPos  + ChDataSize);
+		}
+	}
+}
+
+void IdiBus_3Thermo1HT_ThermoDevice::setAllChErr(uint8_t ErrCode)
+{
+	for (uint8_t I=0; I<IDIBUS_3Thermo1HT_Thermo_CH_COUNT; I++) { this->CH[I].MMES_Error = ErrCode; }
+}

libraries/idiBusMaster/src/IDIBUS_3Thermo1HT.h

@@ -0,0 +1,68 @@
+#ifndef IDIBUS_3Thermo1HT_H_
+#define IDIBUS_3Thermo1HT_H_
+
+#include "IdiBusSlave.h"				//	Common slave defines
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+#define IDIBUS_CUSTDEF_ERCODE_THERMO_CHANNEL_NO_SENSOR						100U
+#define IDIBUS_CUSTDEF_ERCODE_THERMO_CHANNEL_NO_DATA						101U
+#define IDIBUS_CUSTDEF_ERCODE_THERMO_CHANNEL_OVER_UNDER_VOLTAGE				102U
+#define IDIBUS_CUSTDEF_ERCODE_THERMO_CHANNEL_TC_OUT_OF_RANGE				103U
+#define IDIBUS_CUSTDEF_ERCODE_THERMO_CHANNEL_CJ_OUT_OF_RANGE				104U
+#define IDIBUS_CUSTDEF_ERCODE_THERMO_CHANNEL_AUTOCONVERSION_ENABLED			105U	
+#define IDIBUS_CUSTDEF_ERCODE_THERMO_CHANNEL_ONESHOT_IN_PROGRESS			106U	
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+enum IDIBUS_3Thermo1HT_MODULE_DEVICES_LIST {	//	Describe devices on module
+	IDIBUS_3Thermo1HT_THERMO_DEV = 0,			//	Thermocouple device ID
+	IDIBUS_3Thermo1HT_HEATER_DEV,			//	Heater device ID
+	IDIBUS_3Thermo1HT_DEVICES_NUMBER			//	Device count on module
+	};
+
+enum {									//	Describe channel configuration for device (3Thermo1HT)
+	IDIBUS_3Thermo1HT_Thermo_CH0_NUM = 0,			//	Name for 1st channel
+	IDIBUS_3Thermo1HT_Thermo_CH1_NUM,				//			 2nd ...
+	IDIBUS_3Thermo1HT_Thermo_CH2_NUM,				//
+	IDIBUS_3Thermo1HT_Thermo_CH_COUNT				// Module channel count
+	};
+
+class IdiBus_3Thermo1HT_ThermoChannel: public IdiBusChannel {
+	public:
+		IdiBus_3Thermo1HT_ThermoChannel(void);
+		int32_t Temperature;		//	Last temperature 
+		int16_t CJTemperature;		//	Last temperature 
+}; 
+
+class IdiBus_3Thermo1HT_ThermoDevice : public IdiBusDevice {									
+	public:																	
+		IdiBus_3Thermo1HT_ThermoDevice (void *ParentModule) : IdiBusDevice (ParentModule) {}
+
+		uint8_t startOneShotConversion(uint8_t ChNum);
+		uint8_t changeAutomatiocConversionState(uint8_t ChNum);
+		uint8_t getTemperature(uint8_t ChNum);										
+		uint8_t getCJTemperature(uint8_t ChNum);										
+
+		void	startAllOneShotConversions();
+		void	changeAllAutomatiocConversionStates();
+		void    getAllChTemperature(void);												
+		void    getAllChCJTemperature(void);											
+			
+	
+		IdiBus_3Thermo1HT_ThermoChannel  getChData(uint8_t ChNum);				
+	
+	protected :																
+		IdiBus_3Thermo1HT_ThermoChannel  CH[IDIBUS_3Thermo1HT_Thermo_CH_COUNT];						
+		virtual IdiBusChannel *getChannel(uint8_t Num);
+
+		void    setAllChErr(uint8_t ErrCode);									
+};
+
+class IdiBus_3Thermo1HT : public IdiBusSlave {
+	public:
+		IdiBus_3Thermo1HT (IdiBusSerialLine *SlaveLine, uint8_t SlaveAddress) : IdiBusSlave(SlaveLine, SlaveAddress), THERMO_DEV(this)/*, INPV_DEV(this)*/  {}
+		IdiBus_3Thermo1HT() : IdiBusSlave(), THERMO_DEV(this)/*, INPV_DEV(this)*/ {}
+
+		virtual IdiBusDevice *getDevice(uint8_t Num);
+
+		IdiBus_3Thermo1HT_ThermoDevice THERMO_DEV;		 		
+};
+
+#endif /* IDIBUS_43Thermo1HT_H_ */

libraries/idiBusMaster/src/IDIBUS_4ADC.cpp

@@ -0,0 +1,109 @@
+#include "IDIBUS_4ADC.h"
+
+IdiBus_4ADC::IdiBus_4ADC (IdiBusSerialLine *SlaveLine, uint8_t SlaveAddress) : IdiBusSlave(SlaveLine, SlaveAddress)
+{
+	for (uint8_t I=0; I<IDIBUS_4ADC_CH_COUNT; I++)
+	{
+		this->CH[I].MMES_Error = 0;
+		this->CH[I].Voltage = 0;
+		//this->CH[I].STATUS.Enable = 0;
+	}
+}
+
+IdiBus_4ADC::IdiBus_4ADC () : IdiBusSlave()
+{
+	for (uint8_t I=0; I<IDIBUS_4ADC_CH_COUNT; I++)
+	{
+		this->CH[I].MMES_Error = 0;
+		this->CH[I].Voltage = 0;
+		//this->CH[I].STATUS.Enable = 0;
+	}
+}
+
+IDIBUS_4ADC_DATA_TYPE IdiBus_4ADC::getChData(uint8_t ChNum){
+	if ( ChNum < IDIBUS_4ADC_CH_COUNT ) { return this->CH[ChNum]; }
+	else								{ return this->CH[IDIBUS_4ADC_CH4_NUM]; }
+}
+
+uint8_t IdiBus_4ADC::getChVoltage(uint8_t ChNum)
+{
+	if (ChNum >= IDIBUS_4ADC_CH_COUNT) { return IDIERMST_INVALID_CHN_NUM; }
+	IdiBusMMES MMES(this->Address);
+	MMES.DEV.NUM	= IDIBUS_4ADC_CNTRL_DEV;
+	MMES.CHNL.NUM   = ChNum;
+	MMES.ComFunc    = 0x02;	//Get Value
+	uint8_t ChDataSize = 2;		//uint16_t
+	uint8_t RequestError = this->SendRequestMMES(&MMES);
+	if      ( RequestError   != IDIER_NOPE )          { this->CH[ChNum].MMES_Error = RequestError;   }
+	else if ( MMES.RxDataLength == 1 )                { this->CH[ChNum].MMES_Error = MMES.RxData[0]; }
+	else if ( MMES.RxDataLength != (ChDataSize + 1) ) { this->CH[ChNum].MMES_Error = IDIERMST_INVALID_RX_REQUEST_FORMAT; }
+	else {
+		this->CH[ChNum].MMES_Error = MMES.RxData[0];
+		if ( this->CH[ChNum].MMES_Error == IDIER_NOPE )
+		{
+			this->CH[ChNum].Voltage = (uint16_t) (	 ((uint16_t)MMES.RxData[1]<<8) |
+												     ((uint16_t)MMES.RxData[2]));
+		}
+	}
+	return this->CH[ChNum].MMES_Error;
+
+}
+
+void IdiBus_4ADC::getAllAdcVoltage(void)
+{
+	IdiBusMMES MMES(this->Address);
+	MMES.DEV.NUM       = IDIBUS_4ADC_CNTRL_DEV;
+	MMES.DEV.ALLCH     = 1;
+	MMES.ComFunc       = 0x02;
+	uint8_t ChDataSize = 2;		//uint16_t
+	uint8_t RequestError = this->SendRequestMMES(&MMES);
+	if      ( RequestError != IDIER_NOPE )            { this->setAllChErr(RequestError); return; }
+	else if (MMES.RxDataLength < IDIBUS_4ADC_CH_COUNT) { this->setAllChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); return; }
+	else {
+		uint8_t ExpDataLength = IDIBUS_4ADC_CH_COUNT; // Errors
+		for (uint8_t I=0; I<IDIBUS_4ADC_CH_COUNT; I++) {  if ( MMES.RxData[I] == IDIER_NOPE ) { ExpDataLength = (uint16_t)(ExpDataLength + ChDataSize); }  }
+		if ( ExpDataLength != MMES.RxDataLength )     {  this->setAllChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); return;  }
+	}
+	uint8_t ErrorPos = 0;
+	uint8_t DataPos  = ErrorPos + IDIBUS_4ADC_CH_COUNT;
+	for (uint8_t I = 0; I < IDIBUS_4ADC_CH_COUNT; I++)
+	{
+		this->CH[I].MMES_Error = MMES.RxData[ErrorPos];
+		ErrorPos = (uint8_t)(ErrorPos + 1);
+		if ( this->CH[I].MMES_Error == IDIER_NOPE )
+		{
+			this->CH[I].Voltage = (uint16_t) (
+			(uint16_t)((uint16_t)MMES.RxData[DataPos] << 8)  |
+			(uint16_t)((uint16_t)MMES.RxData[DataPos+1])      );
+			DataPos  = (uint8_t)(DataPos  + ChDataSize);
+		}
+	}
+}
+
+void IdiBus_4ADC::setAllChErr(uint8_t ErrCode)
+{
+	for (uint8_t I=0; I<IDIBUS_4ADC_CH_COUNT; I++) { this->CH[I].MMES_Error = ErrCode; }
+}
+
+void IdiBus_4ADC::initAllChs(void)
+{
+	//uint8_t TxData[2];
+	//TxData[0] = (uint8_t)(CurrentLimit >> 8);
+	//TxData[1] = (uint8_t)(CurrentLimit);
+	IdiBusMMES MMES(this->Address);
+	MMES.DEV.NUM       = IDIBUS_4ADC_CNTRL_DEV;
+	MMES.DEV.ALLCH	   = 1;
+	MMES.ComFunc       = 0x01;
+	uint8_t RequestError = this->SendRequestMMES(&MMES);
+	if      ( RequestError != IDIER_NOPE )             { this->setAllChErr(RequestError); }
+	else if (MMES.RxDataLength != IDIBUS_4ADC_CH_COUNT) { this->setAllChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); }
+	else
+	{
+		for (uint8_t I = 0; I < IDIBUS_4ADC_CH_COUNT; I++)
+		{
+			this->CH[I].MMES_Error = MMES.RxData[I];
+			//if ( this->CH[I].MMES_Error == IDIER_NOPE )
+		}
+	}
+}
+

libraries/idiBusMaster/src/IDIBUS_4ADC.h

@@ -0,0 +1,46 @@
+#ifndef IDIBUS_4ADC_H_
+#define IDIBUS_4ADC_H_
+
+#include "IdiBusSlave.h"				//	Common slave defines
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+#define IDIBUS_CUSTDEF_ERCODE_ADC_NOT_INITED						100U
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+enum IDIBUS_4ADC_MODULE_DEVICES_LIST {	//	Describe devices on module
+	IDIBUS_4ADC_CNTRL_DEV = 0,			//	ADC device ID
+	IDIBUS_4ADC_DEVICES_NUMBER			//	Device count on module
+	};
+
+enum {									//	Describe channel configuration for device (ADC)
+	IDIBUS_4ADC_CH1_NUM = 0,			//	Name for 1st channel
+	IDIBUS_4ADC_CH2_NUM,				//			 2nd ...
+	IDIBUS_4ADC_CH3_NUM,				//
+	IDIBUS_4ADC_CH4_NUM,				//
+	IDIBUS_4ADC_12V_NUM,				//	Name for 12v adc channel
+	IDIBUS_4ADC_24V_NUM,				//	Name for 24v adc channel
+	IDIBUS_4ADC_CH_COUNT,				//	Channel count
+	};
+
+typedef struct {
+	uint16_t Voltage;		//	Last voltage
+	uint8_t MMES_Error;		//	Last error
+} IDIBUS_4ADC_DATA_TYPE;	//	Data structure for ADC channels
+
+class IdiBus_4ADC : public IdiBusSlave {									//	ADC module class
+	public:																	//	Public methods 
+ 		IdiBus_4ADC ( IdiBusSerialLine *SlaveLine, uint8_t SlaveAddress);		// Init object with specified bus line and addr
+		IdiBus_4ADC();															// init without specified line and addr (default value line=NULL,addr=1)
+		 	
+		uint8_t getChVoltage(uint8_t ChNum);									// Sends MMES and gets Ch voltage (writes to CH structure and return error code)
+		void    getAllAdcVoltage(void);											// Sends MMES and gets all Ch voltages (writes to CH structure)
+			
+		void    initAllChs(void);												// Inits all adc channels on module
+	
+		IDIBUS_4ADC_DATA_TYPE  getChData(uint8_t ChNum);						// Returns data structure for ADC channel
+	
+	protected :																// 'Private' methods and structures
+		IDIBUS_4ADC_DATA_TYPE  CH[IDIBUS_4ADC_CH_COUNT];						// Data structure array
+			
+		void    setAllChErr(uint8_t ErrCode);									// Set error code for all channels
+};
+
+#endif /* IDIBUS_4ADC_H_ */

libraries/idiBusMaster/src/IDIBUS_4CNT.cpp

@@ -0,0 +1,131 @@
+#include "IDIBUS_4CNT.h"
+
+IdiBus_4CNT::IdiBus_4CNT (IdiBusSerialLine *SlaveLine, uint8_t SlaveAddress) : IdiBusSlave(SlaveLine, SlaveAddress)
+{
+	for (uint8_t I=0; I<IDIBUS_4CNT_CH_COUNT; I++)
+	{
+		this->CH[I].MMES_Error = 0;
+		this->CH[I].Counter = 0;
+		//this->CH[I].STATUS.Enable = 0;
+	}
+}
+
+IdiBus_4CNT::IdiBus_4CNT () : IdiBusSlave()
+{
+	for (uint8_t I=0; I<IDIBUS_4CNT_CH_COUNT; I++)
+	{
+		this->CH[I].MMES_Error = 0;
+		this->CH[I].Counter = 0;
+		//this->CH[I].STATUS.Enable = 0;
+	}
+}
+
+IDIBUS_4CNT_DATA_TYPE IdiBus_4CNT::getChData(uint8_t ChNum){
+	if ( ChNum < IDIBUS_4CNT_CH_COUNT ) { return this->CH[ChNum]; }
+	else								{ return this->CH[IDIBUS_4CNT_CH4_NUM]; }
+}
+
+uint8_t IdiBus_4CNT::getChCounts(uint8_t ChNum)
+{
+	if (ChNum >= IDIBUS_4CNT_CH_COUNT) { return IDIERMST_INVALID_CHN_NUM; }
+	IdiBusMMES MMES(this->Address);
+	MMES.DEV.NUM	= IDIBUS_4CNT_CNTRL_DEV;
+	MMES.CHNL.NUM   = ChNum;
+	MMES.ComFunc    = 0x02;		//Get Value
+	uint8_t ChDataSize = 4;		//uint32_t
+	uint8_t RequestError = this->SendRequestMMES(&MMES);
+	if      ( RequestError   != IDIER_NOPE )          { this->CH[ChNum].MMES_Error = RequestError;   }
+	else if ( MMES.RxDataLength == 1 )                { this->CH[ChNum].MMES_Error = MMES.RxData[0]; }
+	else if ( MMES.RxDataLength != (ChDataSize + 1) ) { this->CH[ChNum].MMES_Error = IDIERMST_INVALID_RX_REQUEST_FORMAT; }
+	else {
+		this->CH[ChNum].MMES_Error = MMES.RxData[0];
+		if ( this->CH[ChNum].MMES_Error == IDIER_NOPE )
+		{
+			this->CH[ChNum].Counter = (uint32_t) (
+			((uint32_t)MMES.RxData[1]	  << 24)  |
+			((uint32_t)MMES.RxData[2]	  << 16)  |
+			((uint32_t)MMES.RxData[3]     << 8 )  |
+			((uint32_t)MMES.RxData[4])      );
+			//this->CH[ChNum].Counter = tmp;
+		}
+	}
+	return this->CH[ChNum].MMES_Error;
+
+}
+
+void IdiBus_4CNT::getAllChsCounts(void)
+{
+	IdiBusMMES MMES(this->Address);
+	MMES.DEV.NUM       = IDIBUS_4CNT_CNTRL_DEV;
+	MMES.DEV.ALLCH     = 1;
+	MMES.ComFunc       = 0x02;
+	uint8_t ChDataSize = 4;		//uint32_t
+	uint8_t RequestError = this->SendRequestMMES(&MMES);
+	if      ( RequestError != IDIER_NOPE )            { this->setAllChErr(RequestError); return; }
+	else if (MMES.RxDataLength < IDIBUS_4CNT_CH_COUNT) { this->setAllChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); return; }
+	else {
+		uint8_t ExpDataLength = IDIBUS_4CNT_CH_COUNT; // Errors
+		for (uint8_t I=0; I<IDIBUS_4CNT_CH_COUNT; I++) {  if ( MMES.RxData[I] == IDIER_NOPE ) { ExpDataLength = (uint16_t)(ExpDataLength + ChDataSize); }  }
+		if ( ExpDataLength != MMES.RxDataLength )     {  this->setAllChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); return;  }
+	}
+	uint8_t ErrorPos = 0;
+	uint8_t DataPos  = ErrorPos + IDIBUS_4CNT_CH_COUNT;
+	for (uint8_t I = 0; I < IDIBUS_4CNT_CH_COUNT; I++)
+	{
+		this->CH[I].MMES_Error = MMES.RxData[ErrorPos];
+		ErrorPos = (uint8_t)(ErrorPos + 1);
+		if ( this->CH[I].MMES_Error == IDIER_NOPE ) {
+			this->CH[I].Counter = (uint32_t) (
+			((uint32_t)MMES.RxData[DataPos]	  << 24)  |
+			((uint32_t)MMES.RxData[DataPos+1] << 16)  |
+			((uint32_t)MMES.RxData[DataPos+2] << 8 )  |
+			((uint32_t)MMES.RxData[DataPos+3])      );
+			DataPos  = (uint8_t)(DataPos  + ChDataSize);
+		}
+	}
+}
+
+void IdiBus_4CNT::setAllChErr(uint8_t ErrCode)
+{
+	for (uint8_t I=0; I<IDIBUS_4CNT_CH_COUNT; I++) { this->CH[I].MMES_Error = ErrCode; }
+}
+
+uint8_t IdiBus_4CNT::initCh(uint8_t ChNum)
+{
+	if (ChNum >= IDIBUS_4CNT_CH_COUNT) { return IDIERMST_INVALID_CHN_NUM; }
+	IdiBusMMES MMES(this->Address);
+	MMES.DEV.NUM       = IDIBUS_4CNT_CNTRL_DEV;
+	MMES.CHNL.NUM	   = ChNum;
+	MMES.ComFunc       = 0x01; //init
+	uint8_t RequestError = this->SendRequestMMES(&MMES);
+	if      ( RequestError   != IDIER_NOPE )          { this->CH[ChNum].MMES_Error = RequestError;   }
+	else if ( MMES.RxDataLength != 1 )                { this->CH[ChNum].MMES_Error = IDIERMST_INVALID_RX_REQUEST_FORMAT; }
+	else {
+		this->CH[ChNum].MMES_Error = MMES.RxData[0];
+	}
+	return this->CH[ChNum].MMES_Error;
+
+}
+
+void IdiBus_4CNT::initAllChs(void)
+{
+	//uint8_t TxData[2];
+	//TxData[0] = (uint8_t)(CurrentLimit >> 8);
+	//TxData[1] = (uint8_t)(CurrentLimit);
+	IdiBusMMES MMES(this->Address);
+	MMES.DEV.NUM       = IDIBUS_4CNT_CNTRL_DEV;
+	MMES.DEV.ALLCH	   = 1;
+	MMES.ComFunc       = 0x01;	//init
+	uint8_t RequestError = this->SendRequestMMES(&MMES);
+	if      ( RequestError != IDIER_NOPE )             { this->setAllChErr(RequestError); }
+	else if (MMES.RxDataLength != IDIBUS_4CNT_CH_COUNT) { this->setAllChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); }
+	else
+	{
+		for (uint8_t I = 0; I < IDIBUS_4CNT_CH_COUNT; I++)
+		{
+			this->CH[I].MMES_Error = MMES.RxData[I];
+			//if ( this->CH[I].MMES_Error == IDIER_NOPE )
+		}
+	}
+}
+

libraries/idiBusMaster/src/IDIBUS_4CNT.h

@@ -0,0 +1,44 @@
+#ifndef IDIBUS_4CNT_H_
+#define IDIBUS_4CNT_H_
+
+#include "IdiBusSlave.h"				//	Common slave defines
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+#define IDIBUS_CUSTDEF_ERCODE_COUNTER_CHANNEL_NOT_INITED						100U
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+enum IDIBUS_4CNT_MODULE_DEVICES_LIST {	//	Describe devices on module
+	IDIBUS_4CNT_CNTRL_DEV = 0,			//	COUNTER device ID
+	IDIBUS_4CNT_DEVICES_NUMBER			//	Device count on module	
+	};
+
+enum {									// Describe channel configuration for device (COUNTER)	
+	IDIBUS_4CNT_CH1_NUM = 0,			// Name for 1st channel
+	IDIBUS_4CNT_CH2_NUM,				//			2nd ...
+	IDIBUS_4CNT_CH3_NUM,				//
+	IDIBUS_4CNT_CH4_NUM,				//
+	IDIBUS_4CNT_CH_COUNT,				// Channel count
+	};
+
+typedef struct {
+	uint32_t Counter;					// Last returned value
+	uint8_t MMES_Error;					// Last error
+} IDIBUS_4CNT_DATA_TYPE;				// Data structure for COUNTER channels
+
+class IdiBus_4CNT : public IdiBusSlave {									//	COUNTER module class
+	public:																	//	Public methods
+ 		IdiBus_4CNT ( IdiBusSerialLine *SlaveLine, uint8_t SlaveAddress);		// Init object with specified bus line and addr 
+		IdiBus_4CNT();															// init without specified line and addr (default value line=NULL,addr=1)
+		 
+		uint8_t getChCounts(uint8_t ChNum);										//	Sends MMES and get Counts on ch (writes to CH structure and returns MMES error code)
+		void    getAllChsCounts(void);											//	Sends MMES and get Counts on ch (writes to CH structure)
+		
+		uint8_t initCh(uint8_t ChNum);											// Inits specified counter channel on module
+		void    initAllChs(void);												// Inits all counters on module
+
+		IDIBUS_4CNT_DATA_TYPE  getChData(uint8_t ChNum);						// Returns data structure
+	
+	protected:																// 'Private' methods and structures			
+		IDIBUS_4CNT_DATA_TYPE  CH[IDIBUS_4CNT_CH_COUNT];						// Data structure array
+		
+		void    setAllChErr(uint8_t ErrCode);									// Set error code for all channels
+};
+#endif

libraries/idiBusMaster/src/IDIBUS_4CNTtoPWM.cpp

@@ -0,0 +1,158 @@
+#include "IDIBUS_4CNTtoPWM.h"
+
+IdiBus_4CNTtoPWM::IdiBus_4CNTtoPWM (IdiBusSerialLine *SlaveLine, uint8_t SlaveAddress) : IdiBusSlave(SlaveLine, SlaveAddress)
+{
+	for (uint8_t I=0; I<IDIBUS_4CNTtoPWM_CH_COUNT; I++)
+	{
+		this->CH[I].MMES_Error = 0;
+		this->CH[I].PWM = 0;
+		//this->CH[I].STATUS.Enable = 0;
+	}
+}
+
+IdiBus_4CNTtoPWM::IdiBus_4CNTtoPWM () : IdiBusSlave()
+{
+	for (uint8_t I=0; I<IDIBUS_4CNTtoPWM_CH_COUNT; I++)
+	{
+		this->CH[I].MMES_Error = 0;
+		this->CH[I].PWM = 0;
+		//this->CH[I].STATUS.Enable = 0;
+	}
+}
+
+IDIBUS_4CNTtoPWM_DATA_TYPE IdiBus_4CNTtoPWM::getChData(uint8_t ChNum){
+	if ( ChNum < IDIBUS_4CNTtoPWM_CH_COUNT ) { return this->CH[ChNum]; }
+	else								{ return this->CH[IDIBUS_4CNTtoPWM_CH4_NUM]; }
+}
+
+uint8_t IdiBus_4CNTtoPWM::setChPwm(uint8_t ChNum, uint8_t pwm)
+{
+	if (ChNum >= IDIBUS_4CNTtoPWM_CH_COUNT) { return IDIERMST_INVALID_CHN_NUM; }
+
+	uint8_t TxData[1];
+	TxData[0] = pwm;
+
+	IdiBusMMES MMES(this->Address, &TxData[0], 1);
+	MMES.DEV.NUM	= IDIBUS_4CNTtoPWM_CNTRL_DEV;
+	MMES.CHNL.NUM   = ChNum;
+	MMES.ComFunc    = 0x02;		//Set Value
+
+	uint8_t RequestError = this->SendRequestMMES(&MMES);
+
+	if      ( RequestError   != IDIER_NOPE )          { this->CH[ChNum].MMES_Error = RequestError;   }
+	else if ( MMES.RxDataLength != 1 )                { this->CH[ChNum].MMES_Error = IDIERMST_INVALID_RX_REQUEST_FORMAT; }
+	else {
+		this->CH[ChNum].MMES_Error = MMES.RxData[0];
+		if ( this->CH[ChNum].MMES_Error == IDIER_NOPE )
+		{
+			this->CH[ChNum].PWM = pwm;
+		}
+	}
+	return this->CH[ChNum].MMES_Error;
+
+}
+
+void IdiBus_4CNTtoPWM::setAllChsPwm(void)
+{
+ uint8_t  TxData[IDIBUS_4CNTtoPWM_CH_COUNT];
+
+ for (uint8_t I=0; I<IDIBUS_4CNTtoPWM_CH_COUNT; I++)
+	{
+	 TxData[I]   = this->CH[I].PWM;
+    }
+
+ IdiBusMMES MMES(this->Address, &TxData[0], IDIBUS_4CNTtoPWM_CH_COUNT);
+ MMES.DEV.NUM       = IDIBUS_4CNTtoPWM_CNTRL_DEV;
+ MMES.DEV.ALLCH     = 1;
+ MMES.ComFunc       = 0x02;
+ uint8_t RequestError = this->SendRequestMMES(&MMES);
+ if      ( RequestError != IDIER_NOPE )             { this->setAllChErr(RequestError); }
+ else if (MMES.RxDataLength != IDIBUS_4CNTtoPWM_CH_COUNT) { this->setAllChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); }
+ else
+	{
+	 for (uint8_t I = 0; I < IDIBUS_4CNTtoPWM_CH_COUNT; I++)
+		{
+		 this->CH[I].MMES_Error = MMES.RxData[I];
+		 //if ( this->CH[I].MMES_Error == IDIER_NOPE )  { this->CH[I].TargetVoltage = TargetV[I]; }
+		}
+	}
+}
+
+/*
+void IdiBus_4CNTtoPWM::setAllChsCounts(void)
+{
+	IdiBusMMES MMES(this->Address);
+	MMES.DEV.NUM       = IDIBUS_4CNTtoPWM_CNTRL_DEV;
+	MMES.DEV.ALLCH     = 1;
+	MMES.ComFunc       = 0x02;
+	uint8_t ChDataSize = 4;		//uint32_t
+	uint8_t RequestError = this->SendRequestMMES(&MMES);
+	if      ( RequestError != IDIER_NOPE )            { this->setAllChErr(RequestError); return; }
+	else if (MMES.RxDataLength < IDIBUS_4CNTtoPWM_CH_COUNT) { this->setAllChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); return; }
+	else {
+		uint8_t ExpDataLength = IDIBUS_4CNTtoPWM_CH_COUNT; // Errors
+		for (uint8_t I=0; I<IDIBUS_4CNTtoPWM_CH_COUNT; I++) {  if ( MMES.RxData[I] == IDIER_NOPE ) { ExpDataLength = (uint16_t)(ExpDataLength + ChDataSize); }  }
+		if ( ExpDataLength != MMES.RxDataLength )     {  this->setAllChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); return;  }
+	}
+	uint8_t ErrorPos = 0;
+	uint8_t DataPos  = ErrorPos + IDIBUS_4CNTtoPWM_CH_COUNT;
+	for (uint8_t I = 0; I < IDIBUS_4CNTtoPWM_CH_COUNT; I++)
+	{
+		this->CH[I].MMES_Error = MMES.RxData[ErrorPos];
+		ErrorPos = (uint8_t)(ErrorPos + 1);
+		if ( this->CH[I].MMES_Error == IDIER_NOPE ) {
+			this->CH[I].Counter = (uint32_t) (
+			((uint32_t)MMES.RxData[DataPos]	  << 24)  |
+			((uint32_t)MMES.RxData[DataPos+1] << 16)  |
+			((uint32_t)MMES.RxData[DataPos+2] << 8 )  |
+			((uint32_t)MMES.RxData[DataPos+3])      );
+			DataPos  = (uint8_t)(DataPos  + ChDataSize);
+		}
+	}
+}
+*/
+
+void IdiBus_4CNTtoPWM::setAllChErr(uint8_t ErrCode)
+{
+	for (uint8_t I=0; I<IDIBUS_4CNTtoPWM_CH_COUNT; I++) { this->CH[I].MMES_Error = ErrCode; }
+}
+
+uint8_t IdiBus_4CNTtoPWM::initCh(uint8_t ChNum)
+{
+	if (ChNum >= IDIBUS_4CNTtoPWM_CH_COUNT) { return IDIERMST_INVALID_CHN_NUM; }
+	IdiBusMMES MMES(this->Address);
+	MMES.DEV.NUM       = IDIBUS_4CNTtoPWM_CNTRL_DEV;
+	MMES.CHNL.NUM	   = ChNum;
+	MMES.ComFunc       = 0x01; //init
+	uint8_t RequestError = this->SendRequestMMES(&MMES);
+	if      ( RequestError   != IDIER_NOPE )          { this->CH[ChNum].MMES_Error = RequestError;   }
+	else if ( MMES.RxDataLength != 1 )                { this->CH[ChNum].MMES_Error = IDIERMST_INVALID_RX_REQUEST_FORMAT; }
+	else {
+		this->CH[ChNum].MMES_Error = MMES.RxData[0];
+	}
+	return this->CH[ChNum].MMES_Error;
+
+}
+
+void IdiBus_4CNTtoPWM::initAllChs(void)
+{
+	//uint8_t TxData[2];
+	//TxData[0] = (uint8_t)(CurrentLimit >> 8);
+	//TxData[1] = (uint8_t)(CurrentLimit);
+	IdiBusMMES MMES(this->Address);
+	MMES.DEV.NUM       = IDIBUS_4CNTtoPWM_CNTRL_DEV;
+	MMES.DEV.ALLCH	   = 1;
+	MMES.ComFunc       = 0x01;	//init
+	uint8_t RequestError = this->SendRequestMMES(&MMES);
+	if      ( RequestError != IDIER_NOPE )             { this->setAllChErr(RequestError); }
+	else if (MMES.RxDataLength != IDIBUS_4CNTtoPWM_CH_COUNT) { this->setAllChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); }
+	else
+	{
+		for (uint8_t I = 0; I < IDIBUS_4CNTtoPWM_CH_COUNT; I++)
+		{
+			this->CH[I].MMES_Error = MMES.RxData[I];
+			//if ( this->CH[I].MMES_Error == IDIER_NOPE )
+		}
+	}
+}
+

libraries/idiBusMaster/src/IDIBUS_4CNTtoPWM.h

@@ -0,0 +1,46 @@
+#ifndef IDIBUS_4CNTtoPWMPWM_H_
+#define IDIBUS_4CNTtoPWMPWM_H_
+
+#include "IdiBusSlave.h"				//	Common slave defines
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+#define IDIBUS_CUSTDEF_ERCODE_COUNTER_CHANNEL_NOT_INITED						100U
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+enum IDIBUS_4CNTtoPWM_MODULE_DEVICES_LIST {	//	Describe devices on module
+	IDIBUS_4CNTtoPWM_CNTRL_DEV = 0,			//	COUNTER device ID
+	IDIBUS_4CNTtoPWM_DEVICES_NUMBER			//	Device count on module	
+	};
+
+enum {									// Describe channel configuration for device (COUNTER)	
+	IDIBUS_4CNTtoPWM_CH1_NUM = 0,			// Name for 1st channel
+	IDIBUS_4CNTtoPWM_CH2_NUM,				//			2nd ...
+	IDIBUS_4CNTtoPWM_CH3_NUM,				//
+	IDIBUS_4CNTtoPWM_CH4_NUM,				//
+	IDIBUS_4CNTtoPWM_CH_COUNT,				// Channel count
+	};
+
+typedef struct {
+	uint8_t PWM;					// Last returned value
+	uint8_t MMES_Error;					// Last error
+} IDIBUS_4CNTtoPWM_DATA_TYPE;				// Data structure for COUNTER channels
+
+class IdiBus_4CNTtoPWM : public IdiBusSlave {									//	COUNTER module class
+	public:																	//	Public methods
+ 		IdiBus_4CNTtoPWM ( IdiBusSerialLine *SlaveLine, uint8_t SlaveAddress);		// Init object with specified bus line and addr 
+		IdiBus_4CNTtoPWM();															// init without specified line and addr (default value line=NULL,addr=1)
+		 
+		uint8_t setChPwm(uint8_t ChNum, uint8_t pwm);										//	Sends MMES and get Counts on ch (writes to CH structure and returns MMES error code)
+		void    setAllChsPwm(void);											//	Sends MMES and get Counts on ch (writes to CH structure)
+
+		void setChPwmLocal(uint8_t ChNum, uint8_t pwm);
+		
+		uint8_t initCh(uint8_t ChNum);											// Inits specified counter channel on module
+		void    initAllChs(void);												// Inits all counters on module
+
+		IDIBUS_4CNTtoPWM_DATA_TYPE  getChData(uint8_t ChNum);						// Returns data structure
+	
+	protected:																// 'Private' methods and structures			
+		IDIBUS_4CNTtoPWM_DATA_TYPE  CH[IDIBUS_4CNTtoPWM_CH_COUNT];						// Data structure array
+		
+		void    setAllChErr(uint8_t ErrCode);									// Set error code for all channels
+};
+#endif

libraries/idiBusMaster/src/IDIBUS_4DC.cpp

@@ -0,0 +1,663 @@
+//#############################################################################################################################################################################################################
+#include "IDIBUS_4DC.h"
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+IdiBusDevice *IdiBus_4DC::getDevice(uint8_t Num)
+{
+ switch (Num)
+	{
+	 case ( IDIBUS_PSU_CNTRL_DEV ) :  { return &this->PSUC_DEV; }
+	 case ( IDIBUS_INPV_CNTRL_DEV ) : { return &this->INPV_DEV; }
+	 default :                        { return NULL; }
+	}
+}
+//=============================================================================================================================================================================================================
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+//=============================================================================================================================================================================================================
+IdiBus_4DC_PSUChannel::IdiBus_4DC_PSUChannel(void) : IdiBusChannel()
+{ 
+ this->TargetVoltage = 0;
+ this->CurrentLimit = 0;
+ this->Voltage = 0;
+ this->Current = 0;
+ this->STATUS.Enable = 0;
+ this->STATUS.PowerGood = 0;
+ this->STATUS.ERRORS.Sum = 0;
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+IdiBusChannel *IdiBus_4DC_PSUCDevice::getChannel(uint8_t Num)
+{
+ if ( Num < IDIBUS_4DC_CH_COUNT ) { return &this->CH[Num]; }
+ else                             { return NULL; }
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+IdiBus_4DC_PSUChannel IdiBus_4DC_PSUCDevice::getChData(uint8_t ChNum)
+{
+ if ( ChNum < IDIBUS_4DC_CH_COUNT ) { return this->CH[ChNum]; }
+ else                               { IdiBus_4DC_PSUChannel NewData; return NewData;  }
+}
+//=============================================================================================================================================================================================================
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+//=============================================================================================================================================================================================================
+IdiBus_4DC_INPVChannel::IdiBus_4DC_INPVChannel(void) : IdiBusChannel()
+{
+ this->InpVoltage = 0;
+ this->STATUS.Sum = 0;
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+IdiBusChannel *IdiBus_4DC_INPVCDevice::getChannel(uint8_t Num)
+{
+ if ( Num == 0 ) { return &this->INPV; }
+ else            { return NULL; }
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+IdiBus_4DC_INPVChannel IdiBus_4DC_INPVCDevice::getChData(void)
+{
+ return this->INPV;
+}
+//=============================================================================================================================================================================================================
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+//=============================================================================================================================================================================================================
+uint8_t IdiBus_4DC_INPVCDevice::getInputVoltage(void)
+{
+ IdiBusMMES MMES( static_cast<IdiBusSlave*>(this->Module)->getAddress() );
+ MMES.DEV.NUM       = IDIBUS_INPV_CNTRL_DEV;
+ MMES.CHNL.NUM      = 0;
+ MMES.ComFunc       = IDIBUS_CUSTDEF_FUNC_CODE_GET_INP_VOLTAGE;
+ uint8_t ChDataSize = IDIBUS_CUSTDEF_PSUINPV_MES_LENGTH;
+ uint8_t RequestError = static_cast<IdiBusSlave*>(this->Module)->SendRequestMMES(&MMES);
+ if      ( RequestError   != IDIER_NOPE )          { this->INPV.MMES_Error = RequestError;   }
+ else if ( MMES.RxDataLength == 1 )                { this->INPV.MMES_Error = MMES.RxData[0]; }
+ else if ( MMES.RxDataLength != (ChDataSize + 1) ) { this->INPV.MMES_Error = IDIERMST_INVALID_RX_REQUEST_FORMAT; }
+else {
+	  this->INPV.MMES_Error = MMES.RxData[0];
+	  if ( this->INPV.MMES_Error == IDIER_NOPE )
+	      {
+		   uint8_t *Data = &MMES.RxData[1];
+		   if ( (Data[IDIBUS_CUSTDEF_PSUINPV_STATE_Pos] & (1U << IDIBUS_CUSTDEF_PSUINPV_STATE_UV_Pos)) != 0 ) { this->INPV.STATUS.BF.Undervoltage = 1; }
+		   else                                                                                               { this->INPV.STATUS.BF.Undervoltage = 0; }
+		   if ( (Data[IDIBUS_CUSTDEF_PSUINPV_STATE_Pos] & (1U << IDIBUS_CUSTDEF_PSUINPV_STATE_OV_Pos)) != 0 ) { this->INPV.STATUS.BF.Overvoltage = 1; }
+		   else                                                                                               { this->INPV.STATUS.BF.Overvoltage = 0; }
+		   this->INPV.InpVoltage = (uint16_t)( (uint16_t)Data[IDIBUS_CUSTDEF_PSUINPV_VOLTAGE_Pos] << 8 ) | MMES.RxData[IDIBUS_CUSTDEF_PSUINPV_VOLTAGE_Pos + 1];
+		  }
+	 }
+ return this->INPV.MMES_Error;
+}
+//=============================================================================================================================================================================================================
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+//=============================================================================================================================================================================================================
+uint8_t IdiBus_4DC_PSUCDevice::getChOutputVoltage(uint8_t ChNum)
+{
+ if ( ChNum >= IDIBUS_4DC_CH_COUNT ) { return IDIERMST_INVALID_CHN_NUM; }
+ IdiBusMMES MMES( static_cast<IdiBusSlave*>(this->Module)->getAddress() );		
+ MMES.DEV.NUM       = IDIBUS_PSU_CNTRL_DEV;
+ MMES.CHNL.NUM      = ChNum;
+ MMES.ComFunc       = IDIBUS_CUSTDEF_FUNC_CODE_PSU_CH_GET_VOLTAGE;
+ uint8_t ChDataSize = 4;		//int32_t
+ uint8_t RequestError = static_cast<IdiBusSlave*>(this->Module)->SendRequestMMES(&MMES);
+ if      ( RequestError   != IDIER_NOPE )          { this->CH[ChNum].MMES_Error = RequestError;   }
+ else if ( MMES.RxDataLength == 1 )                { this->CH[ChNum].MMES_Error = MMES.RxData[0]; }
+ else if ( MMES.RxDataLength != (ChDataSize + 1) ) { this->CH[ChNum].MMES_Error = IDIERMST_INVALID_RX_REQUEST_FORMAT; }
+ else {
+	  this->CH[ChNum].MMES_Error = MMES.RxData[0];
+	  if ( this->CH[ChNum].MMES_Error == IDIER_NOPE )
+	      {
+		   this->CH[ChNum].Voltage = (int32_t) (
+								     (uint32_t)((uint32_t)MMES.RxData[1] << 24) |
+									 (uint32_t)((uint32_t)MMES.RxData[2] << 16) |
+									 (uint32_t)((uint32_t)MMES.RxData[3] << 8)  |
+									 (uint32_t)((uint32_t)MMES.RxData[4])       );
+		  }
+	 }
+ return this->CH[ChNum].MMES_Error;
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+void IdiBus_4DC_PSUCDevice::getAllChOutputVoltage(void)
+{
+ IdiBusMMES MMES( static_cast<IdiBusSlave*>(this->Module)->getAddress() );
+ MMES.DEV.NUM       = IDIBUS_PSU_CNTRL_DEV;
+ MMES.DEV.ALLCH     = 1;
+ MMES.ComFunc       = IDIBUS_CUSTDEF_FUNC_CODE_PSU_CH_GET_VOLTAGE;
+ uint8_t ChDataSize = 4;		//int32_t
+ uint8_t RequestError = static_cast<IdiBusSlave*>(this->Module)->SendRequestMMES(&MMES);
+ if      ( RequestError != IDIER_NOPE )            { this->setAllPsuChErr(RequestError); return; }
+ else if (MMES.RxDataLength < IDIBUS_4DC_CH_COUNT) { this->setAllPsuChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); return; }
+ else {
+	   uint8_t ExpDataLength = IDIBUS_4DC_CH_COUNT; // Errors
+	   for (uint8_t I=0; I<IDIBUS_4DC_CH_COUNT; I++) {  if ( MMES.RxData[I] == IDIER_NOPE ) { ExpDataLength = (uint16_t)(ExpDataLength + ChDataSize); }  }
+	   if ( ExpDataLength != MMES.RxDataLength )     {  this->setAllPsuChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); return;  }
+	  }
+ uint8_t ErrorPos = 0;
+ uint8_t DataPos  = ErrorPos + IDIBUS_4DC_CH_COUNT;
+ for (uint8_t I = 0; I < IDIBUS_4DC_CH_COUNT; I++)
+	{
+	 this->CH[I].MMES_Error = MMES.RxData[ErrorPos];
+	 ErrorPos = (uint8_t)(ErrorPos + 1);
+	 if ( this->CH[I].MMES_Error == IDIER_NOPE )
+		{
+		 this->CH[I].Voltage = (int32_t) (
+							   (uint32_t)((uint32_t)MMES.RxData[DataPos]   << 24) |
+							   (uint32_t)((uint32_t)MMES.RxData[DataPos+1] << 16) |
+							   (uint32_t)((uint32_t)MMES.RxData[DataPos+2] << 8)  |
+							   (uint32_t)((uint32_t)MMES.RxData[DataPos+3])      );
+		 DataPos  = (uint8_t)(DataPos  + ChDataSize);
+		}
+	}
+}
+//=============================================================================================================================================================================================================
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+//=============================================================================================================================================================================================================
+uint8_t IdiBus_4DC_PSUCDevice::getChOutputCurrent(uint8_t ChNum)
+{
+ if ( ChNum >= IDIBUS_4DC_CH_COUNT ) { return IDIERMST_INVALID_CHN_NUM; }
+ IdiBusMMES MMES( static_cast<IdiBusSlave*>(this->Module)->getAddress() );		
+ MMES.DEV.NUM       = IDIBUS_PSU_CNTRL_DEV;
+ MMES.CHNL.NUM      = ChNum;
+ MMES.ComFunc       = IDIBUS_CUSTDEF_FUNC_CODE_PSU_CH_GET_CURRENT;
+ uint8_t ChDataSize = 4;		//int32_t
+ uint8_t RequestError = static_cast<IdiBusSlave*>(this->Module)->SendRequestMMES(&MMES);
+ if      ( RequestError   != IDIER_NOPE )          { this->CH[ChNum].MMES_Error = RequestError;   }
+ else if ( MMES.RxDataLength == 1 )                { this->CH[ChNum].MMES_Error = MMES.RxData[0]; }
+ else if ( MMES.RxDataLength != (ChDataSize + 1) ) { this->CH[ChNum].MMES_Error = IDIERMST_INVALID_RX_REQUEST_FORMAT; }
+ else {
+	  this->CH[ChNum].MMES_Error = MMES.RxData[0];
+	  if ( this->CH[ChNum].MMES_Error == IDIER_NOPE )
+	      {
+		   this->CH[ChNum].Current = (int32_t) (
+								     (uint32_t)((uint32_t)MMES.RxData[1] << 24) |
+									 (uint32_t)((uint32_t)MMES.RxData[2] << 16) |
+									 (uint32_t)((uint32_t)MMES.RxData[3] << 8)  |
+									 (uint32_t)((uint32_t)MMES.RxData[4])       );
+		  }
+	 }
+ return this->CH[ChNum].MMES_Error;
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------	
+void IdiBus_4DC_PSUCDevice::getAllChOutputCurrent(void)
+{
+ IdiBusMMES MMES( static_cast<IdiBusSlave*>(this->Module)->getAddress() );
+ MMES.DEV.NUM       = IDIBUS_PSU_CNTRL_DEV;
+ MMES.DEV.ALLCH     = 1;
+ MMES.ComFunc       = IDIBUS_CUSTDEF_FUNC_CODE_PSU_CH_GET_CURRENT;
+ uint8_t ChDataSize = 4;		//int32_t
+ uint8_t RequestError = static_cast<IdiBusSlave*>(this->Module)->SendRequestMMES(&MMES);
+ if      ( RequestError != IDIER_NOPE )            { this->setAllPsuChErr(RequestError); return; }
+ else if (MMES.RxDataLength < IDIBUS_4DC_CH_COUNT) { this->setAllPsuChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); return; }
+ else {
+	   uint8_t ExpDataLength = IDIBUS_4DC_CH_COUNT; // Errors
+	   for (uint8_t I=0; I<IDIBUS_4DC_CH_COUNT; I++) {  if ( MMES.RxData[I] == IDIER_NOPE ) { ExpDataLength = (uint16_t)(ExpDataLength + ChDataSize); }  }
+	   if ( ExpDataLength != MMES.RxDataLength )     {  this->setAllPsuChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); return;  }
+	  }
+ uint8_t ErrorPos = 0;
+ uint8_t DataPos  = ErrorPos + IDIBUS_4DC_CH_COUNT;
+ for (uint8_t I = 0; I < IDIBUS_4DC_CH_COUNT; I++)
+	{
+	 this->CH[I].MMES_Error = MMES.RxData[ErrorPos];
+	 ErrorPos = (uint8_t)(ErrorPos + 1);
+	 if ( this->CH[I].MMES_Error == IDIER_NOPE )
+		{
+		 this->CH[I].Current = (int32_t) (
+							   (uint32_t)((uint32_t)MMES.RxData[DataPos]   << 24) |
+							   (uint32_t)((uint32_t)MMES.RxData[DataPos+1] << 16) |
+							   (uint32_t)((uint32_t)MMES.RxData[DataPos+2] << 8)  |
+							   (uint32_t)((uint32_t)MMES.RxData[DataPos+3])      );
+		 DataPos  = (uint8_t)(DataPos  + ChDataSize);
+		}
+	}
+}
+//=============================================================================================================================================================================================================
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+//=============================================================================================================================================================================================================
+uint8_t IdiBus_4DC_PSUCDevice::getChStatus(uint8_t ChNum)
+{
+ if ( ChNum >= IDIBUS_4DC_CH_COUNT ) { return IDIERMST_INVALID_CHN_NUM; }
+ IdiBusMMES MMES( static_cast<IdiBusSlave*>(this->Module)->getAddress() );		
+ MMES.DEV.NUM       = IDIBUS_PSU_CNTRL_DEV;
+ MMES.CHNL.NUM      = ChNum;
+ MMES.ComFunc       = IDIBUS_CUSTDEF_FUNC_CODE_PSU_CH_GET_STATUS;
+ uint8_t ChDataSize = IDIBUS_CUSTDEF_PSUCH_STBUF_SIZE;
+ uint8_t RequestError = static_cast<IdiBusSlave*>(this->Module)->SendRequestMMES(&MMES);
+ if      ( RequestError   != IDIER_NOPE )          { this->CH[ChNum].MMES_Error = RequestError;   }
+ else if ( MMES.RxDataLength == 1 )                { this->CH[ChNum].MMES_Error = MMES.RxData[0]; }
+ else if ( MMES.RxDataLength != (ChDataSize + 1) ) { this->CH[ChNum].MMES_Error = IDIERMST_INVALID_RX_REQUEST_FORMAT; }
+ else {
+	  this->CH[ChNum].MMES_Error = MMES.RxData[0];
+	  if ( this->CH[ChNum].MMES_Error == IDIER_NOPE ) { this->parsePsuChState(&MMES.RxData[1], ChNum); }
+	 }	
+ return this->CH[ChNum].MMES_Error;
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------	
+void IdiBus_4DC_PSUCDevice::getAllChStatus(void)
+{
+ IdiBusMMES MMES( static_cast<IdiBusSlave*>(this->Module)->getAddress() );
+ MMES.DEV.NUM       = IDIBUS_PSU_CNTRL_DEV;
+ MMES.DEV.ALLCH     = 1;
+ MMES.ComFunc       = IDIBUS_CUSTDEF_FUNC_CODE_PSU_CH_GET_STATUS;
+ uint8_t ChDataSize = IDIBUS_CUSTDEF_PSUCH_STBUF_SIZE;
+ uint8_t RequestError = static_cast<IdiBusSlave*>(this->Module)->SendRequestMMES(&MMES);
+ if      ( RequestError != IDIER_NOPE )            { this->setAllPsuChErr(RequestError); return; }
+ else if (MMES.RxDataLength < IDIBUS_4DC_CH_COUNT) { this->setAllPsuChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); return; }
+ else {
+	   uint8_t ExpDataLength = IDIBUS_4DC_CH_COUNT; // Errors
+	   for (uint8_t I=0; I<IDIBUS_4DC_CH_COUNT; I++) {  if ( MMES.RxData[I] == IDIER_NOPE ) { ExpDataLength = (uint16_t)(ExpDataLength + ChDataSize); }  }
+	   if ( ExpDataLength != MMES.RxDataLength )     {  this->setAllPsuChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); return;  }
+	  }
+ uint8_t ErrorPos = 0;
+ uint8_t DataPos  = ErrorPos + IDIBUS_4DC_CH_COUNT;
+ for (uint8_t I = 0; I < IDIBUS_4DC_CH_COUNT; I++)
+	{
+	 this->CH[I].MMES_Error = MMES.RxData[ErrorPos];
+	 ErrorPos = (uint8_t)(ErrorPos + 1);
+	 if ( this->CH[I].MMES_Error == IDIER_NOPE )
+		{
+		 this->parsePsuChState(&MMES.RxData[DataPos], I);
+		 DataPos  = (uint8_t)(DataPos  + ChDataSize);
+		}
+	}
+}
+//=============================================================================================================================================================================================================
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+//=============================================================================================================================================================================================================
+uint8_t IdiBus_4DC_PSUCDevice::getChAllData(uint8_t ChNum)
+{
+ if ( ChNum >= IDIBUS_4DC_CH_COUNT ) { return IDIERMST_INVALID_CHN_NUM; }
+ IdiBusMMES MMES( static_cast<IdiBusSlave*>(this->Module)->getAddress() );		
+ MMES.DEV.NUM       = IDIBUS_PSU_CNTRL_DEV;
+ MMES.CHNL.NUM      = ChNum;
+ MMES.ComFunc       = IDIBUS_CUSTDEF_FUNC_CODE_PSU_CH_GET_ALLDATA;
+ uint8_t ChDataSize = IDIBUS_CUSTDEF_PSUCH_STALLBUF_SIZE;
+ uint8_t RequestError = static_cast<IdiBusSlave*>(this->Module)->SendRequestMMES(&MMES);
+ if      ( RequestError   != IDIER_NOPE )          { this->CH[ChNum].MMES_Error = RequestError;   }
+ else if ( MMES.RxDataLength == 1 )                { this->CH[ChNum].MMES_Error = MMES.RxData[0]; }
+ else if ( MMES.RxDataLength != (ChDataSize + 1) ) { this->CH[ChNum].MMES_Error = IDIERMST_INVALID_RX_REQUEST_FORMAT; }
+ else {
+	   this->CH[ChNum].MMES_Error = MMES.RxData[0];
+	   if ( this->CH[ChNum].MMES_Error == IDIER_NOPE ) { this->parsePsuChAllState(&MMES.RxData[1], ChNum); }
+	  }	
+ return this->CH[ChNum].MMES_Error;
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------		
+void IdiBus_4DC_PSUCDevice::getAllChAllData(void)
+{
+ IdiBusMMES MMES( static_cast<IdiBusSlave*>(this->Module)->getAddress() );
+ MMES.DEV.NUM       = IDIBUS_PSU_CNTRL_DEV;
+ MMES.DEV.ALLCH     = 1;
+ MMES.ComFunc       = IDIBUS_CUSTDEF_FUNC_CODE_PSU_CH_GET_ALLDATA;
+ uint8_t ChDataSize = IDIBUS_CUSTDEF_PSUCH_STALLBUF_SIZE;
+ uint8_t RequestError = static_cast<IdiBusSlave*>(this->Module)->SendRequestMMES(&MMES);
+ if      ( RequestError != IDIER_NOPE )            { this->setAllPsuChErr(RequestError); return; }
+ else if (MMES.RxDataLength < IDIBUS_4DC_CH_COUNT) { this->setAllPsuChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); return; }
+ else {
+	   uint8_t ExpDataLength = IDIBUS_4DC_CH_COUNT; // Errors
+	   for (uint8_t I=0; I<IDIBUS_4DC_CH_COUNT; I++) {  if ( MMES.RxData[I] == IDIER_NOPE ) { ExpDataLength = (uint16_t)(ExpDataLength + ChDataSize); }  }
+	   if ( ExpDataLength != MMES.RxDataLength )     {  this->setAllPsuChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); return;  }
+	  }
+ uint8_t ErrorPos = 0;
+ uint8_t DataPos  = ErrorPos + IDIBUS_4DC_CH_COUNT;
+ for (uint8_t I = 0; I < IDIBUS_4DC_CH_COUNT; I++)
+	{
+	 this->CH[I].MMES_Error = MMES.RxData[ErrorPos];
+	 ErrorPos = (uint8_t)(ErrorPos + 1);
+	 if ( this->CH[I].MMES_Error == IDIER_NOPE )
+		{
+		 this->parsePsuChAllState(&MMES.RxData[DataPos], I);
+		 DataPos  = (uint8_t)(DataPos  + ChDataSize);
+		}
+	}
+}
+//=============================================================================================================================================================================================================
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+//=============================================================================================================================================================================================================
+uint8_t IdiBus_4DC_PSUCDevice::setChState(uint8_t ChNum, uint8_t State)
+{
+ if ( ChNum >= IDIBUS_4DC_CH_COUNT ) { return IDIERMST_INVALID_CHN_NUM; }
+ if ( State != 0 ) { State = IDIBUS_CUSTDEF_PSU_CH_STATE_ENABLE; }
+ else			   { State = IDIBUS_CUSTDEF_PSU_CH_STATE_DISABLE; }
+ IdiBusMMES MMES( static_cast<IdiBusSlave*>(this->Module)->getAddress() , &State, 1);
+ MMES.DEV.NUM       = IDIBUS_PSU_CNTRL_DEV;
+ MMES.CHNL.NUM      = ChNum;
+ MMES.ComFunc       = IDIBUS_CUSTDEF_FUNC_CODE_PSU_CH_SET_STATE;
+ uint8_t RequestError = static_cast<IdiBusSlave*>(this->Module)->SendRequestMMES(&MMES);
+ if      ( RequestError   != IDIER_NOPE )          { this->CH[ChNum].MMES_Error = RequestError;   }
+ else if ( MMES.RxDataLength != 1 )                { this->CH[ChNum].MMES_Error = IDIERMST_INVALID_RX_REQUEST_FORMAT; } 
+ else {
+	   this->CH[ChNum].MMES_Error = MMES.RxData[0];
+	   if ( this->CH[ChNum].MMES_Error == IDIER_NOPE ) { this->CH[ChNum].STATUS.Enable = State; }
+	  }
+ return this->CH[ChNum].MMES_Error;
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+void IdiBus_4DC_PSUCDevice::setAllChState(uint8_t State)
+{
+ if ( State != 0 ) { State = IDIBUS_CUSTDEF_PSU_CH_STATE_ENABLE; }
+ else			   { State = IDIBUS_CUSTDEF_PSU_CH_STATE_DISABLE; }
+ 
+ IdiBusMMES MMES( static_cast<IdiBusSlave*>(this->Module)->getAddress() , &State, 1);
+ MMES.DEV.NUM       = IDIBUS_PSU_CNTRL_DEV;
+ MMES.DEV.ALLCH     = 1;
+ MMES.CHNL.ALLSAME  = 1;
+ MMES.ComFunc       = IDIBUS_CUSTDEF_FUNC_CODE_PSU_CH_SET_STATE;
+ uint8_t RequestError = static_cast<IdiBusSlave*>(this->Module)->SendRequestMMES(&MMES);
+ if      ( RequestError != IDIER_NOPE )             { this->setAllPsuChErr(RequestError); }
+ else if (MMES.RxDataLength != IDIBUS_4DC_CH_COUNT) { this->setAllPsuChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); }
+ else
+	{
+	 for (uint8_t I = 0; I < IDIBUS_4DC_CH_COUNT; I++)
+		{
+		 this->CH[I].MMES_Error = MMES.RxData[I];
+		 if ( this->CH[I].MMES_Error == IDIER_NOPE )  { this->CH[I].STATUS.Enable = State; }
+		}
+	}
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+void IdiBus_4DC_PSUCDevice::setAllChState(uint8_t Ch1State, uint8_t Ch2State, uint8_t Ch3State, uint8_t Ch4State)
+{
+ uint8_t State[IDIBUS_4DC_CH_COUNT] = { Ch1State, Ch2State, Ch3State, Ch4State };
+ for (uint8_t I=0; I<IDIBUS_4DC_CH_COUNT; I++)
+	{
+	 if ( State[I] != 0 ) { State[I] = IDIBUS_CUSTDEF_PSU_CH_STATE_ENABLE; }
+	 else			      { State[I] = IDIBUS_CUSTDEF_PSU_CH_STATE_DISABLE; }
+	}
+ IdiBusMMES MMES( static_cast<IdiBusSlave*>(this->Module)->getAddress() , &State[0], IDIBUS_4DC_CH_COUNT);
+ MMES.DEV.NUM       = IDIBUS_PSU_CNTRL_DEV;
+ MMES.DEV.ALLCH     = 1;
+ MMES.ComFunc       = IDIBUS_CUSTDEF_FUNC_CODE_PSU_CH_SET_STATE;
+ uint8_t RequestError = static_cast<IdiBusSlave*>(this->Module)->SendRequestMMES(&MMES);
+ if      ( RequestError != IDIER_NOPE )             { this->setAllPsuChErr(RequestError); }
+ else if (MMES.RxDataLength != IDIBUS_4DC_CH_COUNT) { this->setAllPsuChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); }
+ else
+	{
+	 for (uint8_t I = 0; I < IDIBUS_4DC_CH_COUNT; I++)
+		{
+		 this->CH[I].MMES_Error = MMES.RxData[I];
+		 if ( this->CH[I].MMES_Error == IDIER_NOPE )  { this->CH[I].STATUS.Enable = State[I]; }
+		}
+	}
+}
+//=============================================================================================================================================================================================================
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+//=============================================================================================================================================================================================================
+uint8_t IdiBus_4DC_PSUCDevice::setChVoltage(uint8_t ChNum, uint16_t TargetVoltage)
+{
+ if ( ChNum >= IDIBUS_4DC_CH_COUNT ) { return IDIERMST_INVALID_CHN_NUM; }
+ if ( (TargetVoltage < IDIBUS_PSU_CH_TARG_V_MIN_mV) || (TargetVoltage > IDIBUS_PSU_CH_TARG_V_MAX_mV) )
+	{
+	 this->CH[ChNum].MMES_Error = IDIERMST_INVALID_TX_PARAM;
+	 return IDIERMST_INVALID_TX_PARAM;
+	}
+ uint8_t TxData[2];
+ TxData[0] = (uint8_t)(TargetVoltage >> 8);
+ TxData[1] = (uint8_t)(TargetVoltage);
+ 
+ IdiBusMMES MMES( static_cast<IdiBusSlave*>(this->Module)->getAddress() , &TxData[0], 2);
+ MMES.DEV.NUM       = IDIBUS_PSU_CNTRL_DEV;
+ MMES.CHNL.NUM      = ChNum;
+ MMES.ComFunc       = IDIBUS_CUSTDEF_FUNC_CODE_PSU_CH_SET_TARGET_VOLTAGE;
+ uint8_t RequestError = static_cast<IdiBusSlave*>(this->Module)->SendRequestMMES(&MMES);
+ if      ( RequestError   != IDIER_NOPE )          { this->CH[ChNum].MMES_Error = RequestError;   }
+ else if ( MMES.RxDataLength != 1 )                { this->CH[ChNum].MMES_Error = IDIERMST_INVALID_RX_REQUEST_FORMAT; } 
+ else {
+	   this->CH[ChNum].MMES_Error = MMES.RxData[0];
+	   if ( this->CH[ChNum].MMES_Error == IDIER_NOPE ) { this->CH[ChNum].TargetVoltage = TargetVoltage; }
+	  }
+ return this->CH[ChNum].MMES_Error;
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------		
+void IdiBus_4DC_PSUCDevice::setAllChVoltage(uint16_t TargetVoltage)
+{
+ if ( (TargetVoltage < IDIBUS_PSU_CH_TARG_V_MIN_mV) || (TargetVoltage > IDIBUS_PSU_CH_TARG_V_MAX_mV) ) { this->setAllPsuChErr(IDIERMST_INVALID_TX_PARAM); return; }
+ uint8_t TxData[2];
+ TxData[0] = (uint8_t)(TargetVoltage >> 8);
+ TxData[1] = (uint8_t)(TargetVoltage);
+ IdiBusMMES MMES( static_cast<IdiBusSlave*>(this->Module)->getAddress() , &TxData[0], 2);
+ MMES.DEV.NUM       = IDIBUS_PSU_CNTRL_DEV;
+ MMES.DEV.ALLCH     = 1;
+ MMES.CHNL.ALLSAME  = 1;
+ MMES.ComFunc       = IDIBUS_CUSTDEF_FUNC_CODE_PSU_CH_SET_TARGET_VOLTAGE;
+ uint8_t RequestError = static_cast<IdiBusSlave*>(this->Module)->SendRequestMMES(&MMES);
+ if      ( RequestError != IDIER_NOPE )             { this->setAllPsuChErr(RequestError); }
+ else if (MMES.RxDataLength != IDIBUS_4DC_CH_COUNT) { this->setAllPsuChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); }
+ else
+	{
+	 for (uint8_t I = 0; I < IDIBUS_4DC_CH_COUNT; I++)
+		{
+		 this->CH[I].MMES_Error = MMES.RxData[I];
+		 if ( this->CH[I].MMES_Error == IDIER_NOPE )  { this->CH[I].TargetVoltage = TargetVoltage; }
+		}
+	}
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------		
+void IdiBus_4DC_PSUCDevice::setAllChVoltage(uint16_t TV_CH1, uint16_t TV_CH2, uint16_t TV_CH3, uint16_t TV_CH4)
+{
+ uint16_t TargetV[IDIBUS_4DC_CH_COUNT] = { TV_CH1, TV_CH2, TV_CH3, TV_CH4 };
+ uint8_t  TxData[IDIBUS_4DC_CH_COUNT * 2];
+ for (uint8_t I=0, J=0; I<IDIBUS_4DC_CH_COUNT; I++, J+=2 )
+	{
+	 TxData[J]   = (uint8_t)(TargetV[I] >> 8);
+	 TxData[J+1] = (uint8_t)(TargetV[I]);
+	}
+ IdiBusMMES MMES( static_cast<IdiBusSlave*>(this->Module)->getAddress() , &TxData[0], IDIBUS_4DC_CH_COUNT * 2);
+ MMES.DEV.NUM       = IDIBUS_PSU_CNTRL_DEV;
+ MMES.DEV.ALLCH     = 1;
+ MMES.ComFunc       = IDIBUS_CUSTDEF_FUNC_CODE_PSU_CH_SET_TARGET_VOLTAGE;
+ uint8_t RequestError = static_cast<IdiBusSlave*>(this->Module)->SendRequestMMES(&MMES);
+ if      ( RequestError != IDIER_NOPE )             { this->setAllPsuChErr(RequestError); }
+ else if (MMES.RxDataLength != IDIBUS_4DC_CH_COUNT) { this->setAllPsuChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); }
+ else
+	{
+	 for (uint8_t I = 0; I < IDIBUS_4DC_CH_COUNT; I++)
+		{
+		 this->CH[I].MMES_Error = MMES.RxData[I];
+		 if ( this->CH[I].MMES_Error == IDIER_NOPE )  { this->CH[I].TargetVoltage = TargetV[I]; }
+		}
+	}
+}
+//=============================================================================================================================================================================================================
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+//=============================================================================================================================================================================================================
+uint8_t IdiBus_4DC_PSUCDevice::setChCurrentLimit(uint8_t ChNum, uint16_t CurrentLimit)
+{
+ if ( ChNum >= IDIBUS_4DC_CH_COUNT ) { return IDIERMST_INVALID_CHN_NUM; }
+ if ( (CurrentLimit < IDIBUS_PSU_CH_AVERAGE_CURRENT_LIMIT_MIN) || (CurrentLimit > IDIBUS_PSU_CH_AVERAGE_CURRENT_LIMIT_MAX) )
+	{
+	 this->CH[ChNum].MMES_Error = IDIERMST_INVALID_TX_PARAM;
+	 return IDIERMST_INVALID_TX_PARAM;
+	}	
+ uint8_t TxData[2];
+ TxData[0] = (uint8_t)(CurrentLimit >> 8);
+ TxData[1] = (uint8_t)(CurrentLimit);
+ IdiBusMMES MMES( static_cast<IdiBusSlave*>(this->Module)->getAddress() , &TxData[0], 2);
+ MMES.DEV.NUM       = IDIBUS_PSU_CNTRL_DEV;
+ MMES.CHNL.NUM      = ChNum;
+ MMES.ComFunc       = IDIBUS_CUSTDEF_FUNC_CODE_PSU_CH_SET_CURRENT_LIMIT;
+ uint8_t RequestError = static_cast<IdiBusSlave*>(this->Module)->SendRequestMMES(&MMES);
+ if      ( RequestError   != IDIER_NOPE )          { this->CH[ChNum].MMES_Error = RequestError;   }
+ else if ( MMES.RxDataLength != 1 )                { this->CH[ChNum].MMES_Error = IDIERMST_INVALID_RX_REQUEST_FORMAT; } 
+ else {
+	   this->CH[ChNum].MMES_Error = MMES.RxData[0];
+	   if ( this->CH[ChNum].MMES_Error == IDIER_NOPE ) { this->CH[ChNum].CurrentLimit = CurrentLimit; }
+	  }
+ return this->CH[ChNum].MMES_Error;
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------		
+void IdiBus_4DC_PSUCDevice::setAllChCurrentLimit(uint16_t CurrentLimit)
+{
+ if ( (CurrentLimit < IDIBUS_PSU_CH_AVERAGE_CURRENT_LIMIT_MIN) || (CurrentLimit > IDIBUS_PSU_CH_AVERAGE_CURRENT_LIMIT_MAX) ) { this->setAllPsuChErr(IDIERMST_INVALID_TX_PARAM); return; }
+ uint8_t TxData[2];
+ TxData[0] = (uint8_t)(CurrentLimit >> 8);
+ TxData[1] = (uint8_t)(CurrentLimit);
+ IdiBusMMES MMES( static_cast<IdiBusSlave*>(this->Module)->getAddress() , &TxData[0], 2);
+ MMES.DEV.NUM       = IDIBUS_PSU_CNTRL_DEV;
+ MMES.DEV.ALLCH     = 1;
+ MMES.CHNL.ALLSAME  = 1;
+ MMES.ComFunc       = IDIBUS_CUSTDEF_FUNC_CODE_PSU_CH_SET_CURRENT_LIMIT;
+ uint8_t RequestError = static_cast<IdiBusSlave*>(this->Module)->SendRequestMMES(&MMES);
+ if      ( RequestError != IDIER_NOPE )             { this->setAllPsuChErr(RequestError); }
+ else if (MMES.RxDataLength != IDIBUS_4DC_CH_COUNT) { this->setAllPsuChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); }
+ else
+	{
+	 for (uint8_t I = 0; I < IDIBUS_4DC_CH_COUNT; I++)
+		{
+		 this->CH[I].MMES_Error = MMES.RxData[I];
+		 if ( this->CH[I].MMES_Error == IDIER_NOPE )  { this->CH[I].CurrentLimit = CurrentLimit; }
+		}
+	}
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------		
+void IdiBus_4DC_PSUCDevice::setAllChCurrentLimit(uint16_t CL_CH1, uint16_t CL_CH2, uint16_t CL_CH3, uint16_t CL_CH4)
+{
+ uint16_t CurrentL[IDIBUS_4DC_CH_COUNT] = { CL_CH1, CL_CH2, CL_CH3, CL_CH4 };
+ uint8_t  TxData[IDIBUS_4DC_CH_COUNT * 2];
+ for (uint8_t I=0, J=0; I<IDIBUS_4DC_CH_COUNT; I++, J+=2 )
+	{
+	 TxData[J]   = (uint8_t)(CurrentL[I] >> 8);
+	 TxData[J+1] = (uint8_t)(CurrentL[I]);
+	}
+ IdiBusMMES MMES( static_cast<IdiBusSlave*>(this->Module)->getAddress() , &TxData[0], IDIBUS_4DC_CH_COUNT * 2);
+ MMES.DEV.NUM       = IDIBUS_PSU_CNTRL_DEV;
+ MMES.DEV.ALLCH     = 1;
+ MMES.ComFunc       = IDIBUS_CUSTDEF_FUNC_CODE_PSU_CH_SET_CURRENT_LIMIT;
+ uint8_t RequestError = static_cast<IdiBusSlave*>(this->Module)->SendRequestMMES(&MMES);
+ if      ( RequestError != IDIER_NOPE )             { this->setAllPsuChErr(RequestError); }
+ else if (MMES.RxDataLength != IDIBUS_4DC_CH_COUNT) { this->setAllPsuChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); }
+ else
+	{
+	 for (uint8_t I = 0; I < IDIBUS_4DC_CH_COUNT; I++)
+		{
+		 this->CH[I].MMES_Error = MMES.RxData[I];
+		 if ( this->CH[I].MMES_Error == IDIER_NOPE )  { this->CH[I].CurrentLimit = CurrentL[I]; }
+		}
+	}	
+}
+//=============================================================================================================================================================================================================
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+//=============================================================================================================================================================================================================
+uint8_t IdiBus_4DC_PSUCDevice::setChVoltageAndCurrentLimit(uint8_t ChNum, uint16_t TargetVoltage, uint16_t CurrentLimit)
+{
+ if ( ChNum >= IDIBUS_4DC_CH_COUNT ) { return IDIERMST_INVALID_CHN_NUM; }
+ if ( (CurrentLimit < IDIBUS_PSU_CH_AVERAGE_CURRENT_LIMIT_MIN) || (CurrentLimit > IDIBUS_PSU_CH_AVERAGE_CURRENT_LIMIT_MAX) ||
+	  (TargetVoltage < IDIBUS_PSU_CH_TARG_V_MIN_mV)            || (TargetVoltage > IDIBUS_PSU_CH_TARG_V_MAX_mV) )
+	{
+	 this->CH[ChNum].MMES_Error = IDIERMST_INVALID_TX_PARAM;
+	 return IDIERMST_INVALID_TX_PARAM;
+	}
+ uint8_t TxData[4];
+ TxData[0] = (uint8_t)(TargetVoltage >> 8);
+ TxData[1] = (uint8_t)(TargetVoltage);
+ TxData[2] = (uint8_t)(CurrentLimit >> 8);
+ TxData[3] = (uint8_t)(CurrentLimit);
+ IdiBusMMES MMES( static_cast<IdiBusSlave*>(this->Module)->getAddress() , &TxData[0], 4);
+ MMES.DEV.NUM       = IDIBUS_PSU_CNTRL_DEV;
+ MMES.CHNL.NUM      = ChNum;
+ MMES.ComFunc       = IDIBUS_CUSTDEF_FUNC_CODE_PSU_CH_SET_ALL;
+ uint8_t RequestError = static_cast<IdiBusSlave*>(this->Module)->SendRequestMMES(&MMES);
+ if      ( RequestError   != IDIER_NOPE )          { this->CH[ChNum].MMES_Error = RequestError;   }
+ else if ( MMES.RxDataLength != 1 )                { this->CH[ChNum].MMES_Error = IDIERMST_INVALID_RX_REQUEST_FORMAT; } 
+ else {
+	   this->CH[ChNum].MMES_Error = MMES.RxData[0];
+	   if ( this->CH[ChNum].MMES_Error == IDIER_NOPE ) { this->CH[ChNum].TargetVoltage = TargetVoltage; this->CH[ChNum].CurrentLimit = CurrentLimit; }
+	  }
+ return this->CH[ChNum].MMES_Error;
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------		
+void IdiBus_4DC_PSUCDevice::setAllChVoltageAndCurrentLimit(uint16_t TargetVoltage, uint16_t CurrentLimit)
+{
+ if ( (CurrentLimit < IDIBUS_PSU_CH_AVERAGE_CURRENT_LIMIT_MIN) || (CurrentLimit > IDIBUS_PSU_CH_AVERAGE_CURRENT_LIMIT_MAX) ||
+	  (TargetVoltage < IDIBUS_PSU_CH_TARG_V_MIN_mV)            || (TargetVoltage > IDIBUS_PSU_CH_TARG_V_MAX_mV) )  { this->setAllPsuChErr(IDIERMST_INVALID_TX_PARAM); return; }
+ uint8_t TxData[4];
+ TxData[0] = (uint8_t)(TargetVoltage >> 8);
+ TxData[1] = (uint8_t)(TargetVoltage);
+ TxData[2] = (uint8_t)(CurrentLimit >> 8);
+ TxData[3] = (uint8_t)(CurrentLimit);
+ IdiBusMMES MMES( static_cast<IdiBusSlave*>(this->Module)->getAddress() , &TxData[0], 4);
+ MMES.DEV.NUM       = IDIBUS_PSU_CNTRL_DEV;
+ MMES.DEV.ALLCH     = 1;
+ MMES.CHNL.ALLSAME  = 1;
+ MMES.ComFunc       = IDIBUS_CUSTDEF_FUNC_CODE_PSU_CH_SET_ALL;
+ uint8_t RequestError = static_cast<IdiBusSlave*>(this->Module)->SendRequestMMES(&MMES);
+ if      ( RequestError != IDIER_NOPE )             { this->setAllPsuChErr(RequestError); }
+ else if (MMES.RxDataLength != IDIBUS_4DC_CH_COUNT) { this->setAllPsuChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); }
+ else
+	{
+	 for (uint8_t I = 0; I < IDIBUS_4DC_CH_COUNT; I++)
+		{
+		 this->CH[I].MMES_Error = MMES.RxData[I];
+		 if ( this->CH[I].MMES_Error == IDIER_NOPE ) { this->CH[I].TargetVoltage = TargetVoltage; this->CH[I].CurrentLimit = CurrentLimit; }
+		}
+	}
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------		
+void IdiBus_4DC_PSUCDevice::setAllChVoltageAndCurrentLimit(uint16_t VCH1, uint16_t CCH1, uint16_t VCH2, uint16_t CCH2, uint16_t VCH3, uint16_t CCH3, uint16_t VCH4, uint16_t CCH4)
+{
+ uint16_t CurrentL[IDIBUS_4DC_CH_COUNT] = { CCH1, CCH2, CCH3, CCH4 };
+ uint16_t TargetV[IDIBUS_4DC_CH_COUNT] =  { VCH1, VCH2, VCH3, VCH4 };
+ uint8_t  TxData[IDIBUS_4DC_CH_COUNT * 4];
+ for (uint8_t I=0, J=0; I<IDIBUS_4DC_CH_COUNT; I++, J+=4 )
+	{
+	 TxData[J]   = (uint8_t)(TargetV[I] >> 8);
+	 TxData[J+1] = (uint8_t)(TargetV[I]);
+	 TxData[J+2] = (uint8_t)(CurrentL[I] >> 8);
+	 TxData[J+3] = (uint8_t)(CurrentL[I]);
+	}
+ IdiBusMMES MMES( static_cast<IdiBusSlave*>(this->Module)->getAddress() , &TxData[0], IDIBUS_4DC_CH_COUNT * 4);
+ MMES.DEV.NUM       = IDIBUS_PSU_CNTRL_DEV;
+ MMES.DEV.ALLCH     = 1;
+ MMES.ComFunc       = IDIBUS_CUSTDEF_FUNC_CODE_PSU_CH_SET_ALL;
+ uint8_t RequestError = static_cast<IdiBusSlave*>(this->Module)->SendRequestMMES(&MMES);
+ if      ( RequestError != IDIER_NOPE )             { this->setAllPsuChErr(RequestError); }
+ else if (MMES.RxDataLength != IDIBUS_4DC_CH_COUNT) { this->setAllPsuChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); }
+ else
+	{
+	 for (uint8_t I = 0; I < IDIBUS_4DC_CH_COUNT; I++)
+		{
+		 this->CH[I].MMES_Error = MMES.RxData[I];
+		 if ( this->CH[I].MMES_Error == IDIER_NOPE ) { this->CH[I].TargetVoltage = TargetV[I]; this->CH[I].CurrentLimit = CurrentL[I]; }
+		}
+	}	
+}
+//=============================================================================================================================================================================================================
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+//=============================================================================================================================================================================================================
+void IdiBus_4DC_PSUCDevice::parsePsuChState(uint8_t *State, uint8_t ChNum)
+{
+ if ( (State[IDIBUS_CUSTDEF_PSUCH_STBUF_ST_Pos] & (1U << IDIBUS_CUSTDEF_PSUCH_STBUF_ST_EN_Pos)) != 0 )          { this->CH[ChNum].STATUS.Enable = 1; }
+ else                                                                                                           { this->CH[ChNum].STATUS.Enable = 0; }
+ if ( (State[IDIBUS_CUSTDEF_PSUCH_STBUF_ST_Pos] & (1U << IDIBUS_CUSTDEF_PSUCH_STBUF_ST_PG_Pos)) != 0 )          { this->CH[ChNum].STATUS.PowerGood = 1; }
+ else                                                                                                           { this->CH[ChNum].STATUS.PowerGood = 0; }
+ if ( (State[IDIBUS_CUSTDEF_PSUCH_STBUF_ST_Pos] & (1U << IDIBUS_CUSTDEF_PSUCH_STBUF_ST_PERIPH_ERR_Pos)) != 0 )  { this->CH[ChNum].STATUS.ERRORS.BF.PeripheryError = 1; }
+ else                                                                                                           { this->CH[ChNum].STATUS.ERRORS.BF.PeripheryError = 0; }
+ if ( (State[IDIBUS_CUSTDEF_PSUCH_STBUF_ST_Pos] & (1U << IDIBUS_CUSTDEF_PSUCH_STBUF_ST_OVERCURRENT_ERR_Pos)) != 0 ) { this->CH[ChNum].STATUS.ERRORS.BF.OvercurrentError = 1; }
+ else                                                                                                               { this->CH[ChNum].STATUS.ERRORS.BF.OvercurrentError = 0; }
+ if ( (State[IDIBUS_CUSTDEF_PSUCH_STBUF_ST_Pos] & (1U << IDIBUS_CUSTDEF_PSUCH_STBUF_ST_OVERVOLTAGE_ERR_Pos)) != 0 ) { this->CH[ChNum].STATUS.ERRORS.BF.OvervoltageError = 1; }
+ else                                                                                                               { this->CH[ChNum].STATUS.ERRORS.BF.OvervoltageError = 0; }
+ if ( (State[IDIBUS_CUSTDEF_PSUCH_STBUF_ST_Pos] & (1U << IDIBUS_CUSTDEF_PSUCH_STBUF_ST_OFFSTATELEAKAGE_ERR_Pos)) != 0 ) { this->CH[ChNum].STATUS.ERRORS.BF.OffStateCurrentLeakage = 1; }
+ else                                                                                                                   { this->CH[ChNum].STATUS.ERRORS.BF.OffStateCurrentLeakage = 0; }
+ if ( (State[IDIBUS_CUSTDEF_PSUCH_STBUF_ST_Pos] & (1U << IDIBUS_CUSTDEF_PSUCH_STBUF_ST_MEMORY_ERR_Pos)) != 0 )  { this->CH[ChNum].STATUS.ERRORS.BF.MemoryError = 1; }
+ else                                                                                                           { this->CH[ChNum].STATUS.ERRORS.BF.MemoryError = 0; }
+ if ( (State[IDIBUS_CUSTDEF_PSUCH_STBUF_ST_Pos] & (1U << IDIBUS_CUSTDEF_PSUCH_STBUF_ST_INPV_ERR_Pos)) != 0 )    { this->CH[ChNum].STATUS.ERRORS.BF.InpVoltageError = 1; }
+ else                                                                                                           { this->CH[ChNum].STATUS.ERRORS.BF.InpVoltageError = 0; }	 
+ this->CH[ChNum].TargetVoltage = (uint16_t)( (uint16_t)((uint16_t)State[IDIBUS_CUSTDEF_PSUCH_STBUF_TARGET_VOLATGE_Pos] << 8) | State[IDIBUS_CUSTDEF_PSUCH_STBUF_TARGET_VOLATGE_Pos + 1] );
+ this->CH[ChNum].CurrentLimit  = (uint16_t)( (uint16_t)((uint16_t)State[IDIBUS_CUSTDEF_PSUCH_STBUF_CURRENT_LIMIT_Pos] << 8) | State[IDIBUS_CUSTDEF_PSUCH_STBUF_CURRENT_LIMIT_Pos + 1] );
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+void IdiBus_4DC_PSUCDevice::parsePsuChAllState(uint8_t *State, uint8_t ChNum)
+{
+ this->parsePsuChState(&State[IDIBUS_CUSTDEF_PSUCH_STBUF_ST_Pos], ChNum);
+ this->CH[ChNum].Voltage = (int32_t) (
+						   (uint32_t)((uint32_t)State[IDIBUS_CUSTDEF_PSUCH_STBUF_OUTPUT_VOLTAGE_Pos]     << 24) |
+						   (uint32_t)((uint32_t)State[IDIBUS_CUSTDEF_PSUCH_STBUF_OUTPUT_VOLTAGE_Pos + 1] << 16) |
+						   (uint32_t)((uint32_t)State[IDIBUS_CUSTDEF_PSUCH_STBUF_OUTPUT_VOLTAGE_Pos + 2] << 8)  |
+						   (uint32_t)((uint32_t)State[IDIBUS_CUSTDEF_PSUCH_STBUF_OUTPUT_VOLTAGE_Pos + 3])       );
+ this->CH[ChNum].Current = (int32_t) (
+						   (uint32_t)((uint32_t)State[IDIBUS_CUSTDEF_PSUCH_STBUF_OUTPUT_CURRENT_Pos]     << 24) |
+						   (uint32_t)((uint32_t)State[IDIBUS_CUSTDEF_PSUCH_STBUF_OUTPUT_CURRENT_Pos + 1] << 16) |
+						   (uint32_t)((uint32_t)State[IDIBUS_CUSTDEF_PSUCH_STBUF_OUTPUT_CURRENT_Pos + 2] << 8)  |
+						   (uint32_t)((uint32_t)State[IDIBUS_CUSTDEF_PSUCH_STBUF_OUTPUT_CURRENT_Pos + 3])       );
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+void IdiBus_4DC_PSUCDevice::setAllPsuChErr(uint8_t ErrCode)
+{
+ for (uint8_t I=0; I<IDIBUS_4DC_CH_COUNT; I++) { this->CH[I].MMES_Error = ErrCode; }
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+//#############################################################################################################################################################################################################
+

libraries/idiBusMaster/src/IDIBUS_4DC.h

@@ -0,0 +1,178 @@
+//#############################################################################################################################################################################################################
+#ifndef _IDIBUS_4DC_H_
+#define _IDIBUS_4DC_H_
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+#include "IdiBusSlave.h"
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+#define IDIBUS_CUSTDEF_PSU_CH_STATE_DISABLE						0x00
+#define IDIBUS_CUSTDEF_PSU_CH_STATE_ENABLE						0x01
+
+#define	IDIBUS_CUSTDEF_FUNC_CODE_PSU_CH_SET_STATE 				0x01
+#define IDIBUS_CUSTDEF_FUNC_CODE_PSU_CH_GET_VOLTAGE				0x02
+#define IDIBUS_CUSTDEF_FUNC_CODE_PSU_CH_GET_CURRENT				0x03
+#define IDIBUS_CUSTDEF_FUNC_CODE_PSU_CH_GET_STATUS				0x04
+#define IDIBUS_CUSTDEF_FUNC_CODE_PSU_CH_GET_ALLDATA				0x05
+#define IDIBUS_CUSTDEF_FUNC_CODE_PSU_CH_SET_TARGET_VOLTAGE		0x06
+#define IDIBUS_CUSTDEF_FUNC_CODE_PSU_CH_SET_CURRENT_LIMIT		0x07
+#define IDIBUS_CUSTDEF_FUNC_CODE_PSU_CH_SET_ALL					0x08
+#define IDIBUS_CUSTDEF_FUNC_CODE_GET_INP_VOLTAGE				0x09
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+#define IDIBUS_CUSTDEF_ERCODE_INVALID_DATA						100U
+#define IDIBUS_CUSTDEF_ERCODE_NO_ACCESS							101U
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+#define IDIBUS_CUSTDEF_PSUCH_GET_CV_MES_LENGTH					4U
+
+#define IDIBUS_CUSTDEF_PSUCH_STBUF_ST_Pos						00U
+#define IDIBUS_CUSTDEF_PSUCH_STBUF_ST_EN_Pos					0U
+#define IDIBUS_CUSTDEF_PSUCH_STBUF_ST_PG_Pos					1U
+#define IDIBUS_CUSTDEF_PSUCH_STBUF_ST_PERIPH_ERR_Pos			2U
+#define IDIBUS_CUSTDEF_PSUCH_STBUF_ST_OVERCURRENT_ERR_Pos		3U
+#define IDIBUS_CUSTDEF_PSUCH_STBUF_ST_OVERVOLTAGE_ERR_Pos		4U
+#define IDIBUS_CUSTDEF_PSUCH_STBUF_ST_OFFSTATELEAKAGE_ERR_Pos	5U
+#define IDIBUS_CUSTDEF_PSUCH_STBUF_ST_MEMORY_ERR_Pos			6U
+#define IDIBUS_CUSTDEF_PSUCH_STBUF_ST_INPV_ERR_Pos				7U
+#define IDIBUS_CUSTDEF_PSUCH_STBUF_TARGET_VOLATGE_Pos			01U
+#define IDIBUS_CUSTDEF_PSUCH_STBUF_CURRENT_LIMIT_Pos			03U
+#define IDIBUS_CUSTDEF_PSUCH_STBUF_SIZE							05U
+
+#define IDIBUS_CUSTDEF_PSUCH_STBUF_OUTPUT_VOLTAGE_Pos			IDIBUS_CUSTDEF_PSUCH_STBUF_SIZE
+#define IDIBUS_CUSTDEF_PSUCH_STBUF_OUTPUT_CURRENT_Pos			(IDIBUS_CUSTDEF_PSUCH_STBUF_OUTPUT_VOLTAGE_Pos + 4)
+#define IDIBUS_CUSTDEF_PSUCH_STALLBUF_SIZE						(IDIBUS_CUSTDEF_PSUCH_STBUF_OUTPUT_CURRENT_Pos + 4)
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+#define IDIBUS_CUSTDEF_PSUINPV_STATE_Pos						00U
+#define IDIBUS_CUSTDEF_PSUINPV_STATE_UV_Pos						0U
+#define IDIBUS_CUSTDEF_PSUINPV_STATE_OV_Pos						1U
+#define IDIBUS_CUSTDEF_PSUINPV_VOLTAGE_Pos						01U
+#define IDIBUS_CUSTDEF_PSUINPV_MES_LENGTH						(IDIBUS_CUSTDEF_PSUINPV_VOLTAGE_Pos + 2)
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+#define IDIBUS_PSU_CH_TARG_V_MIN_mV								1500UL
+#define IDIBUS_PSU_CH_TARG_V_MAX_mV								48000UL
+#define IDIBUS_PSU_CH_AVERAGE_CURRENT_LIMIT_MAX					10200UL
+#define IDIBUS_PSU_CH_AVERAGE_CURRENT_LIMIT_MIN					100UL
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+#define PSU_INV_UNDERVOLTAGE_ERR_THR							10000U
+#define PSU_INV_OVERVOLTAGE_ERR_THR								50000U
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+enum IDIBUS_MODULE_DEVICES_LIST {
+	IDIBUS_PSU_CNTRL_DEV = 0x00,
+	IDIBUS_INPV_CNTRL_DEV,
+	IDIBUS_DEVICES_NUMBER
+};
+enum {
+	IDIBUS_4DC_CH1_NUM = 0,
+	IDIBUS_4DC_CH2_NUM,
+	IDIBUS_4DC_CH3_NUM,
+	IDIBUS_4DC_CH4_NUM,
+	IDIBUS_4DC_CH_COUNT
+	};
+//=============================================================================================================================================================================================================
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+//=============================================================================================================================================================================================================
+class IdiBus_4DC_PSUChannel : public IdiBusChannel {
+	public:
+		IdiBus_4DC_PSUChannel(void);
+		int32_t  Voltage;
+		int32_t  Current;
+		uint16_t TargetVoltage;
+		uint16_t CurrentLimit;
+		struct {
+			uint8_t Enable;
+			uint8_t PowerGood;
+			union {
+				uint8_t Sum;
+				struct {
+					uint8_t PeripheryError : 1;
+					uint8_t OvercurrentError : 1;
+					uint8_t OvervoltageError : 1;
+					uint8_t OffStateCurrentLeakage : 1;
+					uint8_t MemoryError : 1;
+					uint8_t InpVoltageError : 1;
+					uint8_t Reserved : 2;
+				} BF;
+			} ERRORS;
+		} STATUS;
+};
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+class IdiBus_4DC_PSUCDevice : public IdiBusDevice {
+	public :
+		IdiBus_4DC_PSUCDevice(void *ParentModule) : IdiBusDevice (ParentModule) {}
+			
+		uint8_t getChStatus(uint8_t ChNum);
+		void    getAllChStatus(void);
+
+		uint8_t getChOutputVoltage(uint8_t ChNum);
+		void    getAllChOutputVoltage(void);
+				
+		uint8_t getChOutputCurrent(uint8_t ChNum);
+		void    getAllChOutputCurrent(void);
+
+		uint8_t getChAllData(uint8_t ChNum);
+		void    getAllChAllData(void);
+				
+		uint8_t setChState(uint8_t ChNum, uint8_t State);
+		void    setAllChState(uint8_t State);
+		void    setAllChState(uint8_t Ch1State, uint8_t Ch2State, uint8_t Ch3State, uint8_t Ch4State);
+
+		uint8_t setChVoltage(uint8_t ChNum, uint16_t TargetVoltage);
+		void    setAllChVoltage(uint16_t TargetVoltage);
+		void    setAllChVoltage(uint16_t TV_CH1, uint16_t TV_CH2, uint16_t TV_CH3, uint16_t TV_CH4);
+
+		uint8_t setChCurrentLimit(uint8_t ChNum, uint16_t CurrentLimit);
+		void    setAllChCurrentLimit(uint16_t CurrentLimit);
+		void    setAllChCurrentLimit(uint16_t CL_CH1, uint16_t CL_CH2, uint16_t CL_CH3, uint16_t CL_CH4);
+
+		uint8_t setChVoltageAndCurrentLimit(uint8_t ChNum, uint16_t TargetVoltage, uint16_t CurrentLimit);
+		void    setAllChVoltageAndCurrentLimit(uint16_t TargetVoltage, uint16_t CurrentLimit);
+		void    setAllChVoltageAndCurrentLimit(uint16_t VCH1, uint16_t CCH1, uint16_t VCH2, uint16_t CCH2, uint16_t VCH3, uint16_t CCH3, uint16_t VCH4, uint16_t CCH4);
+		
+		IdiBus_4DC_PSUChannel getChData(uint8_t ChNum);
+	protected :
+		IdiBus_4DC_PSUChannel  CH[IDIBUS_4DC_CH_COUNT];
+		virtual IdiBusChannel *getChannel(uint8_t Num);
+		void                   parsePsuChState(uint8_t *State, uint8_t ChNum);
+		void                   parsePsuChAllState(uint8_t *State, uint8_t ChNum);
+		void                   setAllPsuChErr(uint8_t ErrCode);
+			
+};
+//=============================================================================================================================================================================================================
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+//=============================================================================================================================================================================================================
+class IdiBus_4DC_INPVChannel : public IdiBusChannel  {
+	public:
+	IdiBus_4DC_INPVChannel(void);
+	uint16_t InpVoltage;
+	union {
+		uint8_t Sum;
+		struct {
+			uint8_t Undervoltage : 1;
+			uint8_t Overvoltage : 1;
+			uint8_t Reserved : 6;
+		} BF;
+	} STATUS;
+};
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+class IdiBus_4DC_INPVCDevice : public IdiBusDevice {
+	public :
+		IdiBus_4DC_INPVCDevice (void *ParentModule) : IdiBusDevice (ParentModule) {}
+		uint8_t                getInputVoltage(void);
+		IdiBus_4DC_INPVChannel getChData(void);
+	protected :
+		IdiBus_4DC_INPVChannel INPV;
+		virtual IdiBusChannel *getChannel(uint8_t Num);
+};
+//=============================================================================================================================================================================================================
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+//=============================================================================================================================================================================================================
+class IdiBus_4DC : public IdiBusSlave {
+	public:
+ 		IdiBus_4DC (IdiBusSerialLine *SlaveLine, uint8_t SlaveAddress) : IdiBusSlave(SlaveLine, SlaveAddress), PSUC_DEV(this), INPV_DEV(this)  {}
+		IdiBus_4DC() : IdiBusSlave(), PSUC_DEV(this), INPV_DEV(this) {}
+			
+		virtual IdiBusDevice *getDevice(uint8_t Num);
+		
+		IdiBus_4DC_PSUCDevice  PSUC_DEV;
+		IdiBus_4DC_INPVCDevice INPV_DEV;
+};
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+#endif //#define _IDIBUS_4DC_H_
+//#############################################################################################################################################################################################################

libraries/idiBusMaster/src/IDIBUS_CO2.cpp

@@ -0,0 +1,81 @@
+#include "IDIBUS_CO2.h"
+
+IdiBus_CO2::IdiBus_CO2 (IdiBusSerialLine *SlaveLine, uint8_t SlaveAddress) : IdiBusSlave(SlaveLine, SlaveAddress)
+{
+	for (uint8_t I=0; I<IDIBUS_CO2_CH_COUNT; I++)
+	{
+		this->CH[I].MMES_Error = 0;
+		this->CH[I].Value = 0;
+		//this->CH[I].STATUS.Enable = 0;
+	}
+}
+
+IdiBus_CO2::IdiBus_CO2 () : IdiBusSlave()
+{
+	for (uint8_t I=0; I<IDIBUS_CO2_CH_COUNT; I++)
+	{
+		this->CH[I].MMES_Error = 0;
+		this->CH[I].Value = 0;
+		//this->CH[I].STATUS.Enable = 0;
+	}
+}
+
+IDIBUS_CO2_DATA_TYPE IdiBus_CO2::getChData(uint8_t ChNum){
+	if ( ChNum < IDIBUS_CO2_CH_COUNT ) { return this->CH[ChNum]; }
+	else								{ return this->CH[IDIBUS_CO2_CH0_NUM]; }
+}
+
+uint8_t IdiBus_CO2::getCO2(uint8_t ChNum)
+{
+	if (ChNum >= IDIBUS_CO2_CH_COUNT) { return IDIERMST_INVALID_CHN_NUM; }
+	IdiBusMMES MMES(this->Address);
+	MMES.DEV.NUM	= IDIBUS_CO2_CNTRL_DEV;
+	MMES.CHNL.NUM   = ChNum;
+	MMES.ComFunc    = 0x01;	//Get Value
+	uint8_t ChDataSize = 4;		//uint32_t
+	uint8_t RequestError = this->SendRequestMMES(&MMES);
+	if      ( RequestError   != IDIER_NOPE )          { this->CH[ChNum].MMES_Error = RequestError;   }
+	else if ( MMES.RxDataLength == 1 )                { this->CH[ChNum].MMES_Error = MMES.RxData[0]; }
+	else if ( MMES.RxDataLength != (ChDataSize + 1) ) { this->CH[ChNum].MMES_Error = IDIERMST_INVALID_RX_REQUEST_FORMAT; }
+	else {
+		this->CH[ChNum].MMES_Error = MMES.RxData[0];
+		if ( this->CH[ChNum].MMES_Error == IDIER_NOPE )
+		{
+			this->CH[ChNum].Value = (uint32_t) (	 ((uint32_t)MMES.RxData[1]<<24) |
+												     ((uint32_t)MMES.RxData[2]<<16) |
+												     ((uint32_t)MMES.RxData[3]<<8)  |
+												     ((uint32_t)MMES.RxData[4]) );
+		}
+	}
+	return this->CH[ChNum].MMES_Error;
+
+}
+
+void IdiBus_CO2::setAllChErr(uint8_t ErrCode)
+{
+	for (uint8_t I=0; I<IDIBUS_CO2_CH_COUNT; I++) { this->CH[I].MMES_Error = ErrCode; }
+}
+
+/*
+void IdiBus_CO2::initAllChs(void)
+{
+	//uint8_t TxData[2];
+	//TxData[0] = (uint8_t)(CurrentLimit >> 8);
+	//TxData[1] = (uint8_t)(CurrentLimit);
+	IdiBusMMES MMES(this->Address);
+	MMES.DEV.NUM       = IDIBUS_CO2_CNTRL_DEV;
+	MMES.DEV.ALLCH	   = 1;
+	MMES.ComFunc       = 0x01;
+	uint8_t RequestError = this->SendRequestMMES(&MMES);
+	if      ( RequestError != IDIER_NOPE )             { this->setAllChErr(RequestError); }
+	else if (MMES.RxDataLength != IDIBUS_CO2_CH_COUNT) { this->setAllChErr(IDIERMST_INVALID_RX_REQUEST_FORMAT); }
+	else
+	{
+		for (uint8_t I = 0; I < IDIBUS_CO2_CH_COUNT; I++)
+		{
+			this->CH[I].MMES_Error = MMES.RxData[I];
+			//if ( this->CH[I].MMES_Error == IDIER_NOPE )
+		}
+	}
+}
+*/

libraries/idiBusMaster/src/IDIBUS_CO2.h

@@ -0,0 +1,41 @@
+#ifndef IDIBUS_CO2_H_
+#define IDIBUS_CO2_H_
+
+#include "IdiBusSlave.h"				//	Common slave defines
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+#define IDIBUS_CUSTDEF_ERCODE_CO2_CRC_ERROR						100U
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+enum IDIBUS_CO2_MODULE_DEVICES_LIST {	//	Describe devices on module
+	IDIBUS_CO2_CNTRL_DEV = 0,			//	ADC device ID
+	IDIBUS_CO2_DEVICES_NUMBER			//	Device count on module
+	};
+
+enum {									//	Describe channel configuration for device (CO2)
+	IDIBUS_CO2_CH0_NUM = 0,			//	Name for 1st channel
+	IDIBUS_CO2_CH_COUNT,				// Module channel count
+	};
+
+typedef struct {
+	uint32_t Value;		//	Last voltage
+	uint8_t MMES_Error;		//	Last error
+} IDIBUS_CO2_DATA_TYPE;	//	Data structure for ADC channels
+
+class IdiBus_CO2 : public IdiBusSlave {									//	ADC module class
+	public:																	//	Public methods 
+ 		IdiBus_CO2 ( IdiBusSerialLine *SlaveLine, uint8_t SlaveAddress);		// Init object with specified bus line and addr
+		IdiBus_CO2 ();															// init without specified line and addr (default value line=NULL,addr=1)
+		 	
+		uint8_t getCO2(uint8_t ChNum);									// Sends MMES and gets Ch voltage (writes to CH structure and return error code)
+		//void    getAllChTemperature(void);											// Sends MMES and gets all Ch voltages (writes to CH structure)
+			
+		//void    initAllChs(void);												// Inits all adc channels on module
+	
+		IDIBUS_CO2_DATA_TYPE  getChData(uint8_t ChNum);						// Returns data structure for ADC channel
+	
+	protected :																// 'Private' methods and structures
+		IDIBUS_CO2_DATA_TYPE  CH[IDIBUS_CO2_CH_COUNT];						// Data structure array
+			
+		void    setAllChErr(uint8_t ErrCode);									// Set error code for all channels
+};
+
+#endif /* IDIBUS_4CO2_H_ */

libraries/idiBusMaster/src/IDIBUS_NEXTION.cpp

@@ -0,0 +1,52 @@
+#include "IDIBUS_NEXTION.h"
+
+IdiBus_NEXTION::IdiBus_NEXTION (IdiBusSerialLine *SlaveLine, uint8_t SlaveAddress) : IdiBusSlave(SlaveLine, SlaveAddress)
+{
+	BRIDGE.MMES_Error = 0;
+	BRIDGE.RXlen = 0;
+}
+
+IdiBus_NEXTION::IdiBus_NEXTION () : IdiBusSlave()
+{
+	BRIDGE.MMES_Error = 0;
+	BRIDGE.RXlen = 0;
+}
+
+IDIBUS_NEXTION_DATA_TYPE IdiBus_NEXTION::getData(void)
+{
+	return this->BRIDGE;
+}
+
+uint8_t IdiBus_NEXTION::getBuf()
+{
+	IdiBusMMES MMES(this->Address);
+	MMES.DEV.NUM	= IDIBUS_NEXTION_CNTRL_DEV;
+	MMES.CHNL.NUM   = 0;
+	MMES.ComFunc    = 0x02;	//Get Buf 
+	uint8_t RequestError = this->SendRequestMMES(&MMES);
+	if      ( RequestError   != IDIER_NOPE )          { this->BRIDGE.MMES_Error = RequestError;   }
+	else {
+		this->BRIDGE.MMES_Error = MMES.RxData[0];
+		this->BRIDGE.RXlen = MMES.RxDataLength-1;
+		memcpy(this->BRIDGE.RXbuf,&MMES.RxData[1],this->BRIDGE.RXlen);
+	}
+	return this->BRIDGE.MMES_Error;
+}
+
+uint8_t IdiBus_NEXTION::sendBuf(uint8_t *buf, uint8_t len)
+{
+	IdiBusMMES MMES(this->Address);
+	MMES.DEV.NUM	= IDIBUS_NEXTION_CNTRL_DEV;
+	MMES.CHNL.NUM   = 0;
+	MMES.ComFunc    = 0x01;	//Send Buf 
+	MMES.TxDataLength = len;
+	MMES.TxData = buf;
+	uint8_t RequestError = this->SendRequestMMES(&MMES);
+
+	if      ( RequestError   != IDIER_NOPE )          { this->BRIDGE.MMES_Error = RequestError;   }
+	else if ( MMES.RxDataLength == 1 )                { this->BRIDGE.MMES_Error = MMES.RxData[0]; }
+	else {
+		this->BRIDGE.MMES_Error = IDIERMST_INVALID_RX_REQUEST_FORMAT;
+	}
+	return this->BRIDGE.MMES_Error;
+}

libraries/idiBusMaster/src/IDIBUS_NEXTION.h

@@ -0,0 +1,31 @@
+#ifndef IDIBUS_NEXTION_H_
+#define IDIBUS_NEXTION_H_
+
+#include "IdiBusSlave.h"				//	Common slave defines
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+enum IDIBUS_NEXTION_MODULE_DEVICES_LIST {	//	Describe devices on module
+	IDIBUS_NEXTION_CNTRL_DEV = 0,			//	NEXTION device ID
+	IDIBUS_NEXTION_DEVICES_NUMBER			//	Device count on module
+	};
+
+typedef struct {
+	uint8_t RXlen;
+	uint8_t RXbuf[255];
+	uint8_t MMES_Error;		//	Last error
+} IDIBUS_NEXTION_DATA_TYPE;
+
+class IdiBus_NEXTION : public IdiBusSlave {									//	NEXTION module class
+	public:																	//	Public methods 
+ 		IdiBus_NEXTION ( IdiBusSerialLine *SlaveLine, uint8_t SlaveAddress);		// Init object with specified bus line and addr
+		IdiBus_NEXTION();															// init without specified line and addr (default value line=NULL,addr=1)
+		 	
+		uint8_t sendBuf(uint8_t *buf, uint8_t len);									// Sends MMES and gets Ch voltage (writes to CH structure and return error code)
+		uint8_t getBuf();
+
+		IDIBUS_NEXTION_DATA_TYPE getData(void);
+	
+	protected :																// 'Private' methods and structures
+		IDIBUS_NEXTION_DATA_TYPE BRIDGE;
+};
+
+#endif /* IDIBUS_NEXTION_H_ */

libraries/idiBusMaster/src/IDIBUS_Speedster.cpp

@@ -0,0 +1,81 @@
+#include "IDIBUS_Speedster.h"
+
+IdiBus_Test::IdiBus_Test (IdiBusSerialLine *SlaveLine, uint8_t SlaveAddress) : IdiBusSlave(SlaveLine, SlaveAddress)
+{
+	for (uint8_t I=0; I<IDIBUS_Test_CH_COUNT; I++)
+	{
+		this->CH[I].MMES_Error = 0;
+		this->CH[I].state = 0x1040FF0A; //Start seed
+		for (uint16_t i = 0; i < 256; i++){
+			this->CH[I].RNG[i] = 0;
+			this->CH[I].DATA[i] = 0;
+		}
+		//this->CH[I].STATUS.Enable = 0;
+	}
+}
+
+IdiBus_Test::IdiBus_Test () : IdiBusSlave()
+{
+	for (uint8_t I=0; I<IDIBUS_Test_CH_COUNT; I++)
+	{
+		this->CH[I].MMES_Error = 0;
+		this->CH[I].state = 0x1040FF0A; //Start seed
+		for (uint16_t i = 0; i < 256; i++){
+			this->CH[I].RNG[i] = 0;
+			this->CH[I].DATA[i] = 0;
+		}
+		//this->CH[I].STATUS.Enable = 0;
+	}
+}
+
+IDIBUS_Test_DATA_TYPE IdiBus_Test::getChData(uint8_t ChNum){
+	if ( ChNum < IDIBUS_Test_CH_COUNT ) { return this->CH[ChNum]; }
+	else								{ return this->CH[IDIBUS_Test_CH_COUNT-1]; }
+}
+
+uint8_t IdiBus_Test::sendPacket(uint8_t ChNum)
+{
+	//Generate random sequence
+	this->CH[ChNum].state = this->xorshift32(this->CH[ChNum].state,this->CH[ChNum].RNG);
+
+	if (ChNum >= IDIBUS_Test_CH_COUNT) { return IDIERMST_INVALID_CHN_NUM; }
+	IdiBusMMES MMES(this->Address);
+	MMES.DEV.NUM	= IDIBUS_Test_CNTRL_DEV;
+	MMES.CHNL.NUM   = ChNum;
+	MMES.ComFunc    = 0x01;	//Send packet
+	MMES.TxDataLength = 256;
+	MMES.TxData = this->CH[ChNum].RNG;
+	uint16_t ChDataSize = 256;		//uint8_t[256]
+	uint8_t RequestError = this->SendRequestMMES(&MMES);
+	if      ( RequestError   != IDIER_NOPE )          { this->CH[ChNum].MMES_Error = RequestError;   }
+	else if ( MMES.RxDataLength == 1 )                { this->CH[ChNum].MMES_Error = MMES.RxData[0]; }
+	else if ( MMES.RxDataLength != (ChDataSize + 1) ) { this->CH[ChNum].MMES_Error = IDIERMST_INVALID_RX_REQUEST_FORMAT; }
+	else {
+		this->CH[ChNum].MMES_Error = MMES.RxData[0];
+		if ( this->CH[ChNum].MMES_Error == IDIER_NOPE )
+		{
+			for (uint16_t i = 0; i < 256; i++)
+				this->CH[ChNum].DATA[i] = MMES.RxData[i+1];
+		}
+	}
+	return this->CH[ChNum].MMES_Error;
+
+}
+
+void IdiBus_Test::setAllChErr(uint8_t ErrCode)
+{
+	for (uint8_t I=0; I<IDIBUS_Test_CH_COUNT; I++) { this->CH[I].MMES_Error = ErrCode; }
+}
+
+uint32_t IdiBus_Test::xorshift32(uint32_t state,uint8_t *data) {
+	for (uint8_t i = 0; i < 256/4; i++){
+		state ^= state << 13;
+		state ^= state >> 17;
+		state ^= state << 5;
+		data[i*4+0] = (uint8_t)state;
+		data[i*4+1] = (uint8_t)(state>>8);
+		data[i*4+2] = (uint8_t)(state>>16);
+		data[i*4+3] = (uint8_t)(state>>24);
+	}	
+	return state;
+}

libraries/idiBusMaster/src/IDIBUS_Speedster.h

@@ -0,0 +1,38 @@
+#ifndef IDIBUS_Test_H_
+#define IDIBUS_Test_H_
+
+#include "IdiBusSlave.h"				//	Common slave defines
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+#define IDIBUS_Test_CH_COUNT 1
+
+enum IDIBUS_Test_MODULE_DEVICES_LIST {	//	Describe devices on module
+	IDIBUS_Test_CNTRL_DEV = 0,			//	ADC device ID
+	IDIBUS_Test_DEVICES_NUMBER			//	Device count on module
+	};
+
+typedef struct {
+	uint8_t RNG[256];
+	uint8_t DATA[256];
+	uint8_t MMES_Error;		//	Last error
+	uint32_t state;
+} IDIBUS_Test_DATA_TYPE;	//	Data structure for ADC channels
+
+class IdiBus_Test : public IdiBusSlave {									//	ADC module class
+	public:																	//	Pulic methods 
+ 		IdiBus_Test ( IdiBusSerialLine *SlaveLine, uint8_t SlaveAddress);		// Init object with specified bus line and addr
+		IdiBus_Test ();															// init without specified line and addr (default value line=NULL,addr=1)
+		 	
+		uint8_t sendPacket(uint8_t ChNum);									// Sends MMES and gets Ch voltage (writes to CH structure and return error code)
+		//void    getAllChTemperature(void);											// Sends MMES and gets all Ch voltages (writes to CH structure)
+			
+		//void    initAllChs(void);												// Inits all adc channels on module
+	
+		IDIBUS_Test_DATA_TYPE  getChData(uint8_t ChNum);						// Returns data structure for ADC channel
+	
+	protected :																// 'Private' methods and structures
+		IDIBUS_Test_DATA_TYPE  CH[IDIBUS_Test_CH_COUNT];						// Data structure array
+		uint32_t	xorshift32(uint32_t state,uint8_t *data);	
+		void    setAllChErr(uint8_t ErrCode);									// Set error code for all channels
+};
+
+#endif /* IDIBUS_41Wire_H_ */

libraries/idiBusMaster/src/IdiBusCallbackInterface.h

@@ -0,0 +1,29 @@
+//#############################################################################################################################################################################################################
+#ifndef _IDIBUS_CALLBACK_INTERFACE_H_
+#define _IDIBUS_CALLBACK_INTERFACE_H_
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+#include <inttypes.h>
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+class IdiBusCallbackInterface {
+	public:
+	static void USART_Callback_InterruptTX   (IdiBusCallbackInterface *inst) { inst->USART_TxInterruptFunc();   }
+	static void USART_Callback_InterruptRX   (IdiBusCallbackInterface *inst) { inst->USART_RxInterruptFunc();   }
+	static void USART_Callback_InterruptUDRE (IdiBusCallbackInterface *inst) { inst->USART_UdreInterruptFunc(); }
+	virtual void USART_RxInterruptFunc(void) {}
+	virtual void USART_TxInterruptFunc(void) {}
+	virtual void USART_UdreInterruptFunc(void) {}
+		
+	static void TIM_Callback_InterruptCOMPA (IdiBusCallbackInterface *inst) { inst->TIM_COMPA_InterruptFunc(); }
+	static void TIM_Callback_InterruptCOMPB (IdiBusCallbackInterface *inst) { inst->TIM_COMPB_InterruptFunc(); }
+	static void TIM_Callback_InterruptCOMPC (IdiBusCallbackInterface *inst) { inst->TIM_COMPC_InterruptFunc(); }
+	static void TIM_Callback_InterruptOVF   (IdiBusCallbackInterface *inst) { inst->TIM_OVF_InterruptFunc();   }
+	virtual void TIM_COMPA_InterruptFunc (void) {}
+	virtual void TIM_COMPB_InterruptFunc (void) {}
+	virtual void TIM_COMPC_InterruptFunc (void) {}
+	virtual void TIM_OVF_InterruptFunc (void)   {}
+	};
+
+typedef void (*CallbackTypeFunction)(IdiBusCallbackInterface*);	
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+#endif //#define _IDIBUS_CALLBACK_INTERFACE_H_
+//#############################################################################################################################################################################################################

libraries/idiBusMaster/src/IdiBusDateTime.cpp

@@ -0,0 +1,57 @@
+//#############################################################################################################################################################################################################
+#include "IdiBusDateTime.h"
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+IdiDateFormat::IdiDateFormat(uint8_t day, uint8_t month, uint8_t century, uint8_t year99)
+{
+ this->Day = day;
+ this->Month = month;
+ this->Century = century;
+ this->Year99 = year99;
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+uint8_t IdiDateFormat::isValid(void)
+{
+ if ( (this->Day == 0) || (this->Day > 31) ||
+      (this->Month == 0) || (this->Month > 12) ||
+	  (this->Century > 99) || (this->Year99 > 99) ) { return 0; }
+return 1;
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+uint8_t IdiDateFormat::getSize(void) { return IDIDATE_FORMAT_LENGTH; }
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+void IdiDateFormat::getBufForMMES(uint8_t *Data)
+{
+ Data[IDIDATE_FORMAT_DAY_Pos]     = this->Day;
+ Data[IDIDATE_FORMAT_MONTH_Pos]   = this->Month;
+ Data[IDIDATE_FORMAT_CENTURY_Pos] = this->Century;
+ Data[IDIDATE_FORMAT_YEAR99_Pos]  = this->Year99;
+}
+//=============================================================================================================================================================================================================
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+//=============================================================================================================================================================================================================
+IdiTimeFormat::IdiTimeFormat(uint8_t seconds, uint8_t minutes, uint8_t hours, int8_t timezone)
+{
+ this->Seconds  = seconds;
+ this->Minutes  = minutes;
+ this->Hours    = hours;
+ this->TimeZone = timezone;
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+uint8_t IdiTimeFormat::isValid(void)
+{
+ if ( (this->Seconds > 60) || (this->Minutes > 60) || (this->Hours > 23) ||
+	  (this->TimeZone < IDITIME_FORMAT_TIMEZONE_MIN) || (this->TimeZone > IDITIME_FORMAT_TIMEZONE_MAX) ) { return 0; }
+ return 1;
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+uint8_t IdiTimeFormat::getSize(void) { return IDITIME_FORMAT_LENGTH; }
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+void IdiTimeFormat::getBufForMMES(uint8_t *Data)
+{
+ Data[IDITIME_FORMAT_SECONDS_Pos]  = this->Seconds;
+ Data[IDITIME_FORMAT_MINUTES_Pos]  = this->Minutes;
+ Data[IDITIME_FORMAT_HOURS_Pos]    = this->Hours;
+ Data[IDITIME_FORMAT_TIMEZONE_Pos] = (uint8_t)this->TimeZone;
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+//#############################################################################################################################################################################################################

libraries/idiBusMaster/src/IdiBusDateTime.h

@@ -0,0 +1,32 @@
+//#############################################################################################################################################################################################################
+#ifndef _IDIBUS_DATE_TIME_H_
+#define _IDIBUS_DATE_TIME_H_
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+#include "IdiBusSystem.h"
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+class IdiDateFormat {
+	public:
+		IdiDateFormat(uint8_t day, uint8_t month, uint8_t century, uint8_t year99);
+		uint8_t Day;
+		uint8_t Month;
+		uint8_t Century;
+		uint8_t Year99;
+		uint8_t isValid(void);
+		uint8_t getSize(void);
+		void    getBufForMMES(uint8_t *Data);
+};
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+class IdiTimeFormat {
+	public:
+		IdiTimeFormat(uint8_t seconds, uint8_t minutes, uint8_t hours, int8_t timezone);
+		uint8_t Seconds;
+		uint8_t Minutes;
+		uint8_t Hours;
+		int8_t  TimeZone;
+		uint8_t isValid(void);
+		uint8_t getSize(void);
+		void    getBufForMMES(uint8_t *Data);
+};
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+#endif //#define _IDIBUS_DATE_TIME_H_
+//#############################################################################################################################################################################################################

libraries/idiBusMaster/src/IdiBusInterruptsDisable.h

@@ -0,0 +1,18 @@
+//#############################################################################################################################################################################################################
+#ifndef _IDIBUS_INTERRUPTS_DISABLE_H_
+#define _IDIBUS_INTERRUPTS_DISABLE_H_
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+#define IDIBUS_USART0_ISR_DISABLE
+//#define IDIBUS_USART1_ISR_DISABLE
+//#define IDIBUS_USART2_ISR_DISABLE
+#define IDIBUS_USART3_ISR_DISABLE
+
+#define IDIBUS_TIM0_ISR_DISABLE
+//#define IDIBUS_TIM1_ISR_DISABLE
+//#define IDIBUS_TIM2_ISR_DISABLE
+//#define IDIBUS_TIM3_ISR_DISABLE
+#define IDIBUS_TIM4_ISR_DISABLE		//	for PWM
+#define IDIBUS_TIM5_ISR_DISABLE		//	for PWM
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+#endif //#define _IDIBUS_INTERRUPTS_DISABLE_H_
+//#############################################################################################################################################################################################################

libraries/idiBusMaster/src/IdiBusInterruptsList.cpp

@@ -0,0 +1,65 @@
+//#############################################################################################################################################################################################################
+#include "IdiBusInterruptsList.h"
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+struct IDIBUS_INTERRUPT_LISTENERS_STR InterruptListenersList;
+//=============================================================================================================================================================================================================
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+//=============================================================================================================================================================================================================
+#ifndef IDIBUS_USART0_ISR_DISABLE
+ISR(USART0_RX_vect)	   { IdiBusCallbackInterface::USART_Callback_InterruptRX(InterruptListenersList.USART0_CallbackInstance);   }
+ISR(USART0_TX_vect)	   { IdiBusCallbackInterface::USART_Callback_InterruptTX(InterruptListenersList.USART0_CallbackInstance);   }
+ISR(USART0_UDRE_vect)  { IdiBusCallbackInterface::USART_Callback_InterruptUDRE(InterruptListenersList.USART0_CallbackInstance); }
+#endif	
+#ifndef IDIBUS_USART1_ISR_DISABLE
+ISR(USART1_RX_vect)	   { IdiBusCallbackInterface::USART_Callback_InterruptRX(InterruptListenersList.USART1_CallbackInstance);   }
+ISR(USART1_TX_vect)	   { IdiBusCallbackInterface::USART_Callback_InterruptTX(InterruptListenersList.USART1_CallbackInstance);   }
+ISR(USART1_UDRE_vect)  { IdiBusCallbackInterface::USART_Callback_InterruptUDRE(InterruptListenersList.USART1_CallbackInstance); }
+#endif	
+#ifndef IDIBUS_USART2_ISR_DISABLE
+ISR(USART2_RX_vect)	   { IdiBusCallbackInterface::USART_Callback_InterruptRX(InterruptListenersList.USART2_CallbackInstance);   }
+ISR(USART2_TX_vect)	   { IdiBusCallbackInterface::USART_Callback_InterruptTX(InterruptListenersList.USART2_CallbackInstance);   }
+ISR(USART2_UDRE_vect)  { IdiBusCallbackInterface::USART_Callback_InterruptUDRE(InterruptListenersList.USART2_CallbackInstance); }
+#endif	
+#ifndef IDIBUS_USART3_ISR_DISABLE
+ISR(USART3_RX_vect)	   { IdiBusCallbackInterface::USART_Callback_InterruptRX(InterruptListenersList.USART3_CallbackInstance);   }
+ISR(USART3_TX_vect)	   { IdiBusCallbackInterface::USART_Callback_InterruptTX(InterruptListenersList.USART3_CallbackInstance);   }
+ISR(USART3_UDRE_vect)  { IdiBusCallbackInterface::USART_Callback_InterruptUDRE(InterruptListenersList.USART3_CallbackInstance); }
+#endif	
+//=============================================================================================================================================================================================================
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+//=============================================================================================================================================================================================================
+#ifndef IDIBUS_TIM0_ISR_DISABLE
+ISR(TIMER0_COMPA_vect) { IdiBusCallbackInterface::TIM_Callback_InterruptCOMPA(InterruptListenersList.TIM0_CallbackInstance); }
+ISR(TIMER0_COMPB_vect) { IdiBusCallbackInterface::TIM_Callback_InterruptCOMPB(InterruptListenersList.TIM0_CallbackInstance); }
+ISR(TIMER0_OVF_vect)   { IdiBusCallbackInterface::TIM_Callback_InterruptOVF(InterruptListenersList.TIM0_CallbackInstance);   }
+#endif
+#ifndef IDIBUS_TIM1_ISR_DISABLE
+ISR(TIMER1_COMPA_vect) { IdiBusCallbackInterface::TIM_Callback_InterruptCOMPA(InterruptListenersList.TIM1_CallbackInstance); }
+ISR(TIMER1_COMPB_vect) { IdiBusCallbackInterface::TIM_Callback_InterruptCOMPB(InterruptListenersList.TIM1_CallbackInstance); }
+ISR(TIMER1_COMPC_vect) { IdiBusCallbackInterface::TIM_Callback_InterruptCOMPC(InterruptListenersList.TIM1_CallbackInstance); }
+ISR(TIMER1_OVF_vect)   { IdiBusCallbackInterface::TIM_Callback_InterruptOVF(InterruptListenersList.TIM1_CallbackInstance);   }
+#endif
+#ifndef IDIBUS_TIM2_ISR_DISABLE
+ISR(TIMER2_COMPA_vect) { IdiBusCallbackInterface::TIM_Callback_InterruptCOMPA(InterruptListenersList.TIM2_CallbackInstance); }
+ISR(TIMER2_COMPB_vect) { IdiBusCallbackInterface::TIM_Callback_InterruptCOMPB(InterruptListenersList.TIM2_CallbackInstance); }
+ISR(TIMER2_OVF_vect)   { IdiBusCallbackInterface::TIM_Callback_InterruptOVF(InterruptListenersList.TIM2_CallbackInstance);   }
+#endif
+#ifndef IDIBUS_TIM3_ISR_DISABLE
+ISR(TIMER3_COMPA_vect) { IdiBusCallbackInterface::TIM_Callback_InterruptCOMPA(InterruptListenersList.TIM3_CallbackInstance); }
+ISR(TIMER3_COMPB_vect) { IdiBusCallbackInterface::TIM_Callback_InterruptCOMPB(InterruptListenersList.TIM3_CallbackInstance); }
+ISR(TIMER3_COMPC_vect) { IdiBusCallbackInterface::TIM_Callback_InterruptCOMPC(InterruptListenersList.TIM3_CallbackInstance); }
+ISR(TIMER3_OVF_vect)   { IdiBusCallbackInterface::TIM_Callback_InterruptOVF(InterruptListenersList.TIM3_CallbackInstance);   }
+#endif
+#ifndef IDIBUS_TIM4_ISR_DISABLE
+ISR(TIMER4_COMPA_vect) { IdiBusCallbackInterface::TIM_Callback_InterruptCOMPA(InterruptListenersList.TIM4_CallbackInstance); }
+ISR(TIMER4_COMPB_vect) { IdiBusCallbackInterface::TIM_Callback_InterruptCOMPB(InterruptListenersList.TIM4_CallbackInstance); }
+ISR(TIMER4_COMPC_vect) { IdiBusCallbackInterface::TIM_Callback_InterruptCOMPC(InterruptListenersList.TIM4_CallbackInstance); }
+ISR(TIMER4_OVF_vect)   { IdiBusCallbackInterface::TIM_Callback_InterruptOVF(InterruptListenersList.TIM4_CallbackInstance);   }
+#endif
+#ifndef IDIBUS_TIM5_ISR_DISABLE
+ISR(TIMER5_COMPA_vect) { IdiBusCallbackInterface::TIM_Callback_InterruptCOMPA(InterruptListenersList.TIM5_CallbackInstance); }
+ISR(TIMER5_COMPB_vect) { IdiBusCallbackInterface::TIM_Callback_InterruptCOMPB(InterruptListenersList.TIM5_CallbackInstance); }
+ISR(TIMER5_COMPC_vect) { IdiBusCallbackInterface::TIM_Callback_InterruptCOMPC(InterruptListenersList.TIM5_CallbackInstance); }
+ISR(TIMER5_OVF_vect)   { IdiBusCallbackInterface::TIM_Callback_InterruptOVF(InterruptListenersList.TIM5_CallbackInstance);   }
+#endif
+//#############################################################################################################################################################################################################

libraries/idiBusMaster/src/IdiBusInterruptsList.h

@@ -0,0 +1,48 @@
+//#############################################################################################################################################################################################################
+#ifndef _IDIBUS_INTERRUPTS_LIST_H_
+#define _IDIBUS_INTERRUPTS_LIST_H_
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+#include <inttypes.h>
+#include <avr/io.h>
+#include <avr/interrupt.h>
+#include "IdiBusCallbackInterface.h"
+#include "IdiBusInterruptsDisable.h"
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+struct IDIBUS_INTERRUPT_LISTENERS_STR {
+	#ifndef IDIBUS_USART0_ISR_DISABLE
+	IdiBusCallbackInterface *USART0_CallbackInstance;
+	#endif
+	#ifndef IDIBUS_USART1_ISR_DISABLE
+	IdiBusCallbackInterface *USART1_CallbackInstance;
+	#endif
+	#ifndef IDIBUS_USART2_ISR_DISABLE
+	IdiBusCallbackInterface *USART2_CallbackInstance;
+	#endif
+	#ifndef IDIBUS_USART3_ISR_DISABLE
+	IdiBusCallbackInterface *USART3_CallbackInstance;
+	#endif
+	
+	#ifndef IDIBUS_TIM0_ISR_DISABLE
+	IdiBusCallbackInterface *TIM0_CallbackInstance;
+	#endif
+	#ifndef IDIBUS_TIM1_ISR_DISABLE
+	IdiBusCallbackInterface *TIM1_CallbackInstance;
+	#endif
+	#ifndef IDIBUS_TIM2_ISR_DISABLE
+	IdiBusCallbackInterface *TIM2_CallbackInstance;
+	#endif
+	#ifndef IDIBUS_TIM3_ISR_DISABLE
+	IdiBusCallbackInterface *TIM3_CallbackInstance;
+	#endif
+	#ifndef IDIBUS_TIM4_ISR_DISABLE
+	IdiBusCallbackInterface *TIM4_CallbackInstance;
+	#endif
+	#ifndef IDIBUS_TIM5_ISR_DISABLE
+	IdiBusCallbackInterface *TIM5_CallbackInstance;
+	#endif
+	};
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+extern struct IDIBUS_INTERRUPT_LISTENERS_STR InterruptListenersList;
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+#endif //_IDIBUS_INTERRUPTS_LIST_H_
+//#############################################################################################################################################################################################################

libraries/idiBusMaster/src/IdiBusMaster.h

@@ -0,0 +1,22 @@
+#include "IDIBUS_1Wire.h"
+#include "IDIBUS_2SALTMETER.h"
+#include "IDIBUS_3Thermo1HT.h"
+#include "IDIBUS_4ADC.h"
+#include "IDIBUS_4CNT.h"
+#include "IDIBUS_4DC.h"
+#include "IDIBUS_NEXTION.h"
+#include "IDIBUS_Speedster.h"
+#include "IDIBUS_1xGen.h"
+
+#include "IdiBusCallbackInterface.h"
+#include "IdiBusDateTime.h"
+#include "IdibusDefs.h"
+#include "IdiBusInterruptsDisable.h"
+#include "IdiBusInterruptsList.h"
+#include "MODBUS_CRC.h"
+#include "IdiBusMes.h"
+#include "IdiBusSerial.h"
+#include "IdiBusSerialDefs.h"
+#include "IdiBusSerialLine.h"
+#include "IdiBusSlave.h"
+#include "IdiBusSystem.h"

libraries/idiBusMaster/src/IdiBusMes.cpp

@@ -0,0 +1,128 @@
+//#############################################################################################################################################################################################################
+#include "IdiBusMes.h"
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+uint8_t IdiBusMessage::IsGroupAddr(void) { return ( (this->SlAddr >= IDIBUS_GROUP_0_ADDR)&&(this->SlAddr <= IDIBUS_GROUP_15_ADDR) ) ? 1 : 0; }
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+uint8_t IdiBusMessage::IsCommand(void)   { return ( this->ComFunc >= IDIMMES_COM_START_NUM ) ? 1 : 0; }
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+uint8_t IdiBusMessage::IsModuleError(uint8_t ErrCode) { return ((ErrCode >= IDIER_MODULE_NUM_START)&&(ErrCode <= IDIER_MODULE_NUM_END)) ? 1 : 0; }
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+uint8_t IdiBusMessage::IsModuleCommand(void)
+{
+ switch (this->ComFunc)
+	{
+	 case(IDIMMES_COM_C_Init)               :
+	 case(IDIMMES_COM_C_ShtDown)            :
+	 case(IDIMMES_COM_C_Freeze)             :
+	 case(IDIMMES_COM_C_Resume)             :
+	 case(IDIMMES_COM_C_SetAlarmL12)        :
+	 case(IDIMMES_COM_C_SetAlarmL)          :
+	 case(IDIMMES_COM_C_SyncRead)           :
+	 case(IDIMMES_COM_C_SyncDoChnl)         :
+	 case(IDIMMES_COM_C_SyncDo)             :
+	 case(IDIMMES_COM_C_SyncClear)          :
+	 case(IDIMMES_COM_C_SendTimeDate)       :
+	 case(IDIMMES_COM_C_MkTimedMaster)      :
+	 case(IDIMMES_COM_C_FmwUpd)             :
+	 case(IDIMMES_COM_C_EndFmwUpd)          :
+	 case(IDIMMES_COM_C_FmwWrite)           :
+	 case(IDIMMES_COM_C_ReadDevFullSN_MS)   :
+	 case(IDIMMES_COM_C_WriteSnIPv4IPv6)    :
+	 case(IDIMMES_COM_C_WriteSnVerifyDates) :
+	 case(IDIMMES_COM_C_WriteSnAES256)      :
+	 case(IDIMMES_COM_C_DummyModule)        : 
+	 case(IDIMMES_COM_C_CheckModuleLongOp)  : { return 1; }
+	 default : {}
+ 	}
+ return 0;
+}
+//=============================================================================================================================================================================================================
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+//=============================================================================================================================================================================================================
+IdiBusMMES::IdiBusMMES (uint8_t SlAddr, uint8_t *TX_DataP, uint16_t TX_DataLength)
+{
+ this->SlAddr = SlAddr;
+ this->MMPS.LongMes = 0;
+ this->MMPS.AlarmMes = 0;
+ this->MMPS.EncryptedAes = 0;
+ this->DEV.NUM = 0;
+ this->DEV.ALLCH = 0;
+ this->CHNL.ALLSAME = 0;
+ this->CHNL.NUM = 0;
+ this->ComFunc = 1;
+
+ this->TxData = TX_DataP;
+ this->TxDataLength = TX_DataLength;
+ this->RxData = NULL;
+ this->RxDataLength = 0;
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+IdiBusMMES::IdiBusMMES (uint8_t SlAddr)
+{
+ this->SlAddr = SlAddr;
+ this->MMPS.LongMes = 0;
+ this->MMPS.AlarmMes = 0;
+ this->MMPS.EncryptedAes = 0;
+ this->DEV.NUM = 0;
+ this->DEV.ALLCH = 0;
+ this->CHNL.ALLSAME = 0;
+ this->CHNL.NUM = 0;
+ this->ComFunc = IDIMMES_COM_C_Dummy;
+
+ this->TxData = NULL;
+ this->TxDataLength = 0;
+ this->RxData = NULL;
+ this->RxDataLength = 0;
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+uint8_t IdiBusMMES::IsValid(void)
+{
+ if ( (this->ComFunc == 0) || this->IsModuleCommand() || this->IsGroupAddr() ) { return 0; }
+ return 1;
+}
+//=============================================================================================================================================================================================================
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+//=============================================================================================================================================================================================================
+IdiBusMMESG::IdiBusMMESG (uint8_t SlAddr, uint8_t *TX_DataP, uint16_t TX_DataLength)
+{
+ this->SlAddr = SlAddr;
+ this->MMPS.LongMes = 0;
+ this->MMPS.AlarmMes = 0;
+ this->MMPS.EncryptedAes = 0;
+ this->ComFunc = IDIMMES_COM_C_DummyModule;
+
+ this->TxData = TX_DataP;
+ this->TxDataLength = TX_DataLength;
+ this->RxData = NULL;
+ this->RxDataLength = 0;
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+IdiBusMMESG::IdiBusMMESG (uint8_t SlAddr)
+{
+ this->SlAddr = SlAddr;
+ this->MMPS.LongMes = 0;
+ this->MMPS.AlarmMes = 0;
+ this->MMPS.EncryptedAes = 0;
+ this->ComFunc = IDIMMES_COM_C_Dummy;
+
+ this->TxData = NULL;
+ this->TxDataLength = 0;
+ this->RxData = NULL;
+ this->RxDataLength = 0;
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+uint8_t IdiBusMMESG::IsValid(void)
+{
+ uint8_t isModuleCommand = this->IsModuleCommand();
+ uint8_t isGroupAddress  = this->IsGroupAddr();
+ 
+ if ( this->ComFunc == IDIMMES_NOT_FAST_FUNC ) { return 0; }
+ if ( isGroupAddress )
+	{
+	 if ( isModuleCommand != 0 ) { return 0; }
+	}
+	else if ( isModuleCommand == 0 ) { return 0; }
+ return 1;
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+//#############################################################################################################################################################################################################

libraries/idiBusMaster/src/IdiBusMes.h

@@ -0,0 +1,50 @@
+//#############################################################################################################################################################################################################
+#ifndef _IDIBUS_MES_H_
+#define _IDIBUS_MES_H_
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+#include "IdiBusSystem.h"
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+class IdiBusMessage {
+	public :
+		uint8_t	    SlAddr;
+		struct {
+			uint8_t LongMes		 : 1;
+			uint8_t AlarmMes     : 1;
+			uint8_t EncryptedAes : 1;
+			} MMPS;
+		uint8_t  ComFunc;
+		uint8_t *TxData;
+		uint16_t  TxDataLength;
+		uint8_t *RxData;
+		uint16_t  RxDataLength;
+	
+		uint8_t IsGroupAddr(void);
+		uint8_t IsModuleCommand(void);
+		uint8_t IsCommand(void);
+		uint8_t IsModuleError(uint8_t ErrCode);
+};
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+class IdiBusMMES : public IdiBusMessage {
+	public :
+		IdiBusMMES (uint8_t SlAddr, uint8_t *TX_DataP, uint16_t TX_DataLength);
+		IdiBusMMES (uint8_t SlAddr);
+		struct {
+			uint8_t NUM   : 5;
+			uint8_t ALLCH : 1;
+			} DEV;
+		struct {
+			uint8_t NUM     : 7;
+			uint8_t ALLSAME : 1;
+			} CHNL;
+		uint8_t IsValid(void);
+};
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+class IdiBusMMESG : public IdiBusMessage {
+	public :
+		IdiBusMMESG (uint8_t SlAddr, uint8_t *TX_DataP, uint16_t TX_DataLength);
+		IdiBusMMESG (uint8_t SlAddr);
+		uint8_t IsValid(void);
+};
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+#endif //#define _IDIBUS_MES_H_
+//#############################################################################################################################################################################################################

libraries/idiBusMaster/src/IdiBusSerial.cpp

@@ -0,0 +1,621 @@
+//#############################################################################################################################################################################################################
+#include "IdiBusSerial.h"
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+IdiBusSerial::IdiBusSerial(void)
+{
+ this->RS485_DIR_GPIO.DDR  = (uint8_t*)&this->InitProtectionVar;
+ this->RS485_DIR_GPIO.PIN  = (uint8_t*)&this->InitProtectionVar;
+ this->RS485_DIR_GPIO.PORT = (uint8_t*)&this->InitProtectionVar;
+ this->BAUDRATE_DIPSW.S0_Gpio.DDR  = (uint8_t*)&this->InitProtectionVar;
+ this->BAUDRATE_DIPSW.S0_Gpio.PIN  = (uint8_t*)&this->InitProtectionVar;
+ this->BAUDRATE_DIPSW.S0_Gpio.PORT = (uint8_t*)&this->InitProtectionVar;
+ this->BAUDRATE_DIPSW.S1_Gpio.DDR  = (uint8_t*)&this->InitProtectionVar;
+ this->BAUDRATE_DIPSW.S1_Gpio.PIN  = (uint8_t*)&this->InitProtectionVar;
+ this->BAUDRATE_DIPSW.S1_Gpio.PORT = (uint8_t*)&this->InitProtectionVar;
+ this->BAUDRATE_DIPSW.S2_Gpio.DDR  = (uint8_t*)&this->InitProtectionVar;
+ this->BAUDRATE_DIPSW.S2_Gpio.PIN  = (uint8_t*)&this->InitProtectionVar;
+ this->BAUDRATE_DIPSW.S2_Gpio.PORT = (uint8_t*)&this->InitProtectionVar;
+ this->USARTN.UCSRNA = (uint8_t*)&this->InitProtectionVar;
+ this->USARTN.UCSRNB = (uint8_t*)&this->InitProtectionVar;
+ this->USARTN.UCSRNC = (uint8_t*)&this->InitProtectionVar;
+ this->USARTN.UBRRN  = (uint16_t*)&this->InitProtectionVar;
+ this->USARTN.UDRN   = (uint8_t*)&this->InitProtectionVar;
+ this->TIMN.TCCRNA   = (uint8_t*)&this->InitProtectionVar;
+ this->TIMN.TCCRNB   = (uint8_t*)&this->InitProtectionVar;
+ this->TIMN.TIMSKN   = (uint8_t*)&this->InitProtectionVar;
+ this->TIMN.TIFRN    = (uint8_t*)&this->InitProtectionVar;
+ this->TIMN.OCRNA    = (uint16_t*)&this->InitProtectionVar;
+ this->TIMN.OCRNB    = (uint16_t*)&this->InitProtectionVar;
+ this->TIMN.TCNTN    = (uint16_t*)&this->InitProtectionVar;
+ this->InitState = 0;
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+uint8_t IdiBusSerial::Init(IDIBUS_SERIAL_INIT_TYPEDEF *InitT)
+{
+ if ( (this->GetGpioParamsArduino(InitT->RS485_DIR_PIN,         &this->RS485_DIR_GPIO) == 0)         ||
+	  (this->GetGpioParamsArduino(InitT->BAUDRATE_DIPSW_S0_PIN, &this->BAUDRATE_DIPSW.S0_Gpio) == 0) ||
+	  (this->GetGpioParamsArduino(InitT->BAUDRATE_DIPSW_S1_PIN, &this->BAUDRATE_DIPSW.S1_Gpio) == 0) ||
+	  (this->GetGpioParamsArduino(InitT->BAUDRATE_DIPSW_S2_PIN, &this->BAUDRATE_DIPSW.S2_Gpio) == 0)  ) { return 0; }
+ 
+ return this->BaseInit(InitT->USART_NUMBER, InitT->TIMER_NUMBER, InitT->CONFIG);
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+uint8_t IdiBusSerial::Init(IDIBUS_SERIAL_ALTERNATIVE_INIT_TYPEDEF *InitT)
+{
+ if ( (this->GetGpioParams(&InitT->RS485_DIR_GPIO,    &this->RS485_DIR_GPIO) == 0)         ||
+	  (this->GetGpioParams(&InitT->BAUDRATE_DIPSW.S0, &this->BAUDRATE_DIPSW.S0_Gpio) == 0) ||
+	  (this->GetGpioParams(&InitT->BAUDRATE_DIPSW.S1, &this->BAUDRATE_DIPSW.S1_Gpio) == 0) ||
+	  (this->GetGpioParams(&InitT->BAUDRATE_DIPSW.S2, &this->BAUDRATE_DIPSW.S2_Gpio) == 0) )  { return 0; }
+ 
+ return this->BaseInit(InitT->USART_NUMBER, InitT->TIMER_NUMBER, InitT->CONFIG);
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+uint8_t IdiBusSerial::BaseInit(	enum IDIBUS_SERIAL_USARTN_NUMBER USART_NUM, enum IDIBUS_SERIAL_TIMER_NUMBER TIMER_NUM, enum IDIBUS_SERIAL_USARTN_CONFIG CONF)
+{
+  // Pointers Init
+ switch (USART_NUM)
+	{
+	 case (IDIBUS_SERIAL_USART0) : {
+			#if defined IDIBUS_USART0_ISR_DISABLE
+			return 0;
+			#else
+			this->USARTN.UCSRNA = &(UCSR0A);
+			this->USARTN.UCSRNB = &(UCSR0B);
+			this->USARTN.UCSRNC = &(UCSR0C);
+			this->USARTN.UBRRN  = &(UBRR0);
+			this->USARTN.UDRN   = &(UDR0);
+			InterruptListenersList.USART0_CallbackInstance = this;
+			#endif
+			break; }
+	 case (IDIBUS_SERIAL_USART1) : {
+			#if defined IDIBUS_USART1_ISR_DISABLE
+			return 0;
+			#else
+			this->USARTN.UCSRNA = &(UCSR1A);
+			this->USARTN.UCSRNB = &(UCSR1B);
+			this->USARTN.UCSRNC = &(UCSR1C);
+			this->USARTN.UBRRN  = &(UBRR1);
+			this->USARTN.UDRN   = &(UDR1);
+			InterruptListenersList.USART1_CallbackInstance = this;
+			#endif
+			break; }
+	 case (IDIBUS_SERIAL_USART2) : {
+			#if defined IDIBUS_USART2_ISR_DISABLE
+			return 0;
+			#else
+			this->USARTN.UCSRNA = &(UCSR2A);
+			this->USARTN.UCSRNB = &(UCSR2B);
+			this->USARTN.UCSRNC = &(UCSR2C);
+			this->USARTN.UBRRN  = &(UBRR2);
+			this->USARTN.UDRN   = &(UDR2);
+			InterruptListenersList.USART2_CallbackInstance = this;
+			#endif
+			break; }
+	 case (IDIBUS_SERIAL_USART3) : {
+		 	#if defined IDIBUS_USART3_ISR_DISABLE
+			return 0;
+			#else
+			this->USARTN.UCSRNA = &(UCSR3A);
+			this->USARTN.UCSRNB = &(UCSR3B);
+			this->USARTN.UCSRNC = &(UCSR3C);
+			this->USARTN.UBRRN  = &(UBRR3);
+			this->USARTN.UDRN   = &(UDR3);
+			InterruptListenersList.USART3_CallbackInstance = this;
+			#endif
+			break; }
+	 default : { return 0; }
+	}
+
+ switch (TIMER_NUM)
+	{
+	case (IDIBUS_TIMER_1) : {
+			#if defined IDIBUS_TIM1_ISR_DISABLE
+			return 0;
+			#else
+			this->TIMN.TCCRNA = &(TCCR1A);
+			this->TIMN.TCCRNB = &(TCCR1B);
+			this->TIMN.TIMSKN = &(TIMSK1);
+			this->TIMN.TIFRN  = &(TIFR1);
+			this->TIMN.OCRNA  = &(OCR1A);
+			this->TIMN.OCRNB  = &(OCR1B);
+			this->TIMN.TCNTN  = &(TCNT1);
+			InterruptListenersList.TIM1_CallbackInstance = this;
+			#endif
+			break; }
+	 case (IDIBUS_TIMER_3) : {
+			#if defined IDIBUS_TIM3_ISR_DISABLE
+			return 0;
+			#else
+			this->TIMN.TCCRNA = &(TCCR3A);
+			this->TIMN.TCCRNB = &(TCCR3B);
+			this->TIMN.TIMSKN = &(TIMSK3);
+			this->TIMN.TIFRN  = &(TIFR3);
+			this->TIMN.OCRNA  = &(OCR3A);
+			this->TIMN.OCRNB  = &(OCR3B);
+			this->TIMN.TCNTN  = &(TCNT3);
+			InterruptListenersList.TIM3_CallbackInstance = this;
+			#endif
+			break; }
+	 case (IDIBUS_TIMER_4) : {
+			#if defined IDIBUS_TIM4_ISR_DISABLE
+			return 0;
+			#else
+			this->TIMN.TCCRNA = &(TCCR4A);
+			this->TIMN.TCCRNB = &(TCCR4B);
+			this->TIMN.TIMSKN = &(TIMSK4);
+			this->TIMN.TIFRN  = &(TIFR4);
+			this->TIMN.OCRNA  = &(OCR4A);
+			this->TIMN.OCRNB  = &(OCR4B);
+			this->TIMN.TCNTN  = &(TCNT4);
+			InterruptListenersList.TIM4_CallbackInstance = this;
+			#endif
+			break; }
+	 case (IDIBUS_TIMER_5) : {
+			#if defined IDIBUS_TIM5_ISR_DISABLE
+			return 0;
+			#else
+			this->TIMN.TCCRNA = &(TCCR5A);
+			this->TIMN.TCCRNB = &(TCCR5B);
+			this->TIMN.TIMSKN = &(TIMSK5);
+			this->TIMN.TIFRN  = &(TIFR5);
+			this->TIMN.OCRNA  = &(OCR5A);
+			this->TIMN.OCRNB  = &(OCR5B);
+			this->TIMN.TCNTN  = &(TCNT5);
+			InterruptListenersList.TIM5_CallbackInstance = this;
+			#endif
+			break; }
+	 default : { return 0; }
+	}
+ 
+ // GPIO Init
+ uint8_t SREG_Temp = SREG;
+ cli();
+ *this->RS485_DIR_GPIO.PORT &= ~this->RS485_DIR_GPIO.PIN_MASK;
+ *this->RS485_DIR_GPIO.DDR  |=  this->RS485_DIR_GPIO.PIN_MASK;
+ 
+ *this->BAUDRATE_DIPSW.S0_Gpio.PORT &= ~this->BAUDRATE_DIPSW.S0_Gpio.PIN_MASK;
+ *this->BAUDRATE_DIPSW.S0_Gpio.DDR  &= ~this->BAUDRATE_DIPSW.S0_Gpio.PIN_MASK;
+ 
+ *this->BAUDRATE_DIPSW.S1_Gpio.PORT &= ~this->BAUDRATE_DIPSW.S1_Gpio.PIN_MASK;
+ *this->BAUDRATE_DIPSW.S1_Gpio.DDR  &= ~this->BAUDRATE_DIPSW.S1_Gpio.PIN_MASK;
+ 
+ *this->BAUDRATE_DIPSW.S2_Gpio.PORT &= ~this->BAUDRATE_DIPSW.S2_Gpio.PIN_MASK;
+ *this->BAUDRATE_DIPSW.S2_Gpio.DDR  &= ~this->BAUDRATE_DIPSW.S2_Gpio.PIN_MASK;
+ if ( SREG_Temp & (0x01U << SREG_I) ) { sei(); }
+ 
+ // USART Init
+ *this->USARTN.UBRRN = 0;
+ *this->USARTN.UCSRNA = (1U<<USARTN_UCSRNA_U2X_Pos);
+ *this->USARTN.UCSRNB = 0;
+ this->BAUDRATE = 0;
+ switch (CONF)
+	{
+	 case (IDIBUS_SERIAL_8N1) : { *this->USARTN.UCSRNC = (1U<<USARTN_UCSRNC_UCSZ0)|(1U<<USARTN_UCSRNC_UCSZ1)|(0U<<USARTN_UCSRNC_USBS)|(0U<<USARTN_UCSRNC_UPM1)|(0U<<USARTN_UCSRNC_UPM0); break; }
+	 case (IDIBUS_SERIAL_8N2) : { *this->USARTN.UCSRNC = (1U<<USARTN_UCSRNC_UCSZ0)|(1U<<USARTN_UCSRNC_UCSZ1)|(1U<<USARTN_UCSRNC_USBS)|(0U<<USARTN_UCSRNC_UPM1)|(0U<<USARTN_UCSRNC_UPM0); break; }
+	 case (IDIBUS_SERIAL_8E1) : { *this->USARTN.UCSRNC = (1U<<USARTN_UCSRNC_UCSZ0)|(1U<<USARTN_UCSRNC_UCSZ1)|(0U<<USARTN_UCSRNC_USBS)|(1U<<USARTN_UCSRNC_UPM1)|(0U<<USARTN_UCSRNC_UPM0); break; }
+	 case (IDIBUS_SERIAL_8E2) : { *this->USARTN.UCSRNC = (1U<<USARTN_UCSRNC_UCSZ0)|(1U<<USARTN_UCSRNC_UCSZ1)|(1U<<USARTN_UCSRNC_USBS)|(1U<<USARTN_UCSRNC_UPM1)|(0U<<USARTN_UCSRNC_UPM0); break; }
+	 case (IDIBUS_SERIAL_8O1) : { *this->USARTN.UCSRNC = (1U<<USARTN_UCSRNC_UCSZ0)|(1U<<USARTN_UCSRNC_UCSZ1)|(0U<<USARTN_UCSRNC_USBS)|(1U<<USARTN_UCSRNC_UPM1)|(1U<<USARTN_UCSRNC_UPM0); break; }
+	 case (IDIBUS_SERIAL_8O2) : { *this->USARTN.UCSRNC = (1U<<USARTN_UCSRNC_UCSZ0)|(1U<<USARTN_UCSRNC_UCSZ1)|(1U<<USARTN_UCSRNC_USBS)|(1U<<USARTN_UCSRNC_UPM1)|(1U<<USARTN_UCSRNC_UPM0); break; }
+	 default : { return 0; }
+	}
+ 
+ // TIMER Init
+ *this->TIMN.TCCRNB = 0;	// Counter stop
+ *this->TIMN.TCCRNA = 0;	// Normal Mode
+ *this->TIMN.TIMSKN = 0;
+ 
+ this->InitState = 1;
+ return 1;
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+void IdiBusSerial::SetBaudrate(enum IDIBUS_SERIAL_BAUDRATE Baudrate)
+{
+ switch ( Baudrate )
+	{
+	 case (IDIBUS_BAUDRATE_DSW_CODE_2400B) : {
+		this->SetBaudrateLL(2400);
+		this->TimerInterFrameCompValue = (uint16_t)( ((uint64_t)IDIBUS_2400B_INTERFRAME_TIMEOUT_US      * (uint64_t)F_CPU / (uint64_t)IDIBUS_SERIAL_TIMER_PR_VALUE ) / 1000000ULL );
+		this->TimerTimeoutCompValue    = (uint16_t)( ((uint64_t)IDIBUS_2400B_MASTER_RESPONSE_TIMEOUT_US * (uint64_t)F_CPU  / (uint32_t)IDIBUS_SERIAL_TIMER_PR_VALUE) / 1000000ULL );
+		break; }
+	 case (IDIBUS_BAUDRATE_DSW_CODE_9600B) : {
+		this->SetBaudrateLL(9600);
+		this->TimerInterFrameCompValue = (uint16_t)( ((uint64_t)IDIBUS_9600B_INTERFRAME_TIMEOUT_US      * (uint64_t)F_CPU / (uint64_t)IDIBUS_SERIAL_TIMER_PR_VALUE ) / 1000000ULL );
+		this->TimerTimeoutCompValue    = (uint16_t)( ((uint64_t)IDIBUS_9600B_MASTER_RESPONSE_TIMEOUT_US * (uint64_t)F_CPU  / (uint32_t)IDIBUS_SERIAL_TIMER_PR_VALUE) / 1000000ULL );
+		break; }
+	 case (IDIBUS_BAUDRATE_DSW_CODE_19200B) : {
+		this->SetBaudrateLL(19200);
+		this->TimerInterFrameCompValue = (uint16_t)( ((uint64_t)IDIBUS_19200B_INTERFRAME_TIMEOUT_US      * (uint64_t)F_CPU / (uint64_t)IDIBUS_SERIAL_TIMER_PR_VALUE ) / 1000000ULL );
+		this->TimerTimeoutCompValue    = (uint16_t)( ((uint64_t)IDIBUS_19200B_MASTER_RESPONSE_TIMEOUT_US * (uint64_t)F_CPU  / (uint64_t)IDIBUS_SERIAL_TIMER_PR_VALUE) / 1000000ULL );
+		break; }
+	 case (IDIBUS_BAUDRATE_DSW_CODE_115200B) : {
+		this->SetBaudrateLL(115200);
+		this->TimerInterFrameCompValue = (uint16_t)( ((uint64_t)IDIBUS_115200B_INTERFRAME_TIMEOUT_US      * (uint64_t)F_CPU / (uint64_t)IDIBUS_SERIAL_TIMER_PR_VALUE ) / 1000000ULL );
+		this->TimerTimeoutCompValue    = (uint16_t)( ((uint64_t)IDIBUS_115200B_MASTER_RESPONSE_TIMEOUT_US * (uint64_t)F_CPU  / (uint64_t)IDIBUS_SERIAL_TIMER_PR_VALUE) / 1000000ULL );
+		break; }
+	 case (IDIBUS_BAUDRATE_DSW_CODE_250K) : { 
+		this->SetBaudrateLL(250000);
+		this->TimerInterFrameCompValue = (uint16_t)( ((uint64_t)IDIBUS_250K_INTERFRAME_TIMEOUT_US      * (uint64_t)F_CPU / (uint64_t)IDIBUS_SERIAL_TIMER_PR_VALUE ) / 1000000ULL );
+		this->TimerTimeoutCompValue    = (uint16_t)( ((uint64_t)IDIBUS_250K_MASTER_RESPONSE_TIMEOUT_US * (uint64_t)F_CPU  / (uint64_t)IDIBUS_SERIAL_TIMER_PR_VALUE) / 1000000ULL );
+		 break; }
+	 case (IDIBUS_BAUDRATE_DSW_CODE_500K) : {
+		this->SetBaudrateLL(500000);
+		this->TimerInterFrameCompValue = (uint16_t)( ((uint64_t)IDIBUS_500K_INTERFRAME_TIMEOUT_US      * (uint64_t)F_CPU / (uint64_t)IDIBUS_SERIAL_TIMER_PR_VALUE ) / 1000000ULL );
+		this->TimerTimeoutCompValue    = (uint16_t)( ((uint64_t)IDIBUS_500K_MASTER_RESPONSE_TIMEOUT_US * (uint64_t)F_CPU  / (uint64_t)IDIBUS_SERIAL_TIMER_PR_VALUE) / 1000000ULL );
+		break; }
+	 case (IDIBUS_BAUDRATE_DSW_CODE_1M) : {
+		this->SetBaudrateLL(1000000);
+		this->TimerInterFrameCompValue = (uint16_t)( ((uint64_t)IDIBUS_1M_INTERFRAME_TIMEOUT_US      * (uint64_t)F_CPU / (uint64_t)IDIBUS_SERIAL_TIMER_PR_VALUE ) / 1000000ULL );
+		this->TimerTimeoutCompValue    = (uint16_t)( ((uint64_t)IDIBUS_1M_MASTER_RESPONSE_TIMEOUT_US * (uint64_t)F_CPU  / (uint64_t)IDIBUS_SERIAL_TIMER_PR_VALUE) / 1000000ULL );
+		break; }
+	 case (IDIBUS_BAUDRATE_DSW_CODE_10M) : {
+		this->SetBaudrateLL(10000000);
+		this->TimerInterFrameCompValue = (uint16_t)( ((uint64_t)IDIBUS_10M_INTERFRAME_TIMEOUT_US      * (uint64_t)F_CPU / (uint64_t)IDIBUS_SERIAL_TIMER_PR_VALUE ) / 1000000ULL );
+		this->TimerTimeoutCompValue    = (uint16_t)( ((uint64_t)IDIBUS_10M_MASTER_RESPONSE_TIMEOUT_US * (uint64_t)F_CPU  / (uint64_t)IDIBUS_SERIAL_TIMER_PR_VALUE) / 1000000ULL );
+		break; }
+	 default : { return; }
+	}
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+void IdiBusSerial::UpdateBaudrateFromDipSwitch(void)
+{
+ uint8_t  BaudrateCode = 0;
+ uint32_t BaudrateCodeValue;
+ if ( (*this->BAUDRATE_DIPSW.S2_Gpio.PIN & this->BAUDRATE_DIPSW.S2_Gpio.PIN_MASK) != 0 ) { BaudrateCode |= 0x04; }
+ if ( (*this->BAUDRATE_DIPSW.S1_Gpio.PIN & this->BAUDRATE_DIPSW.S1_Gpio.PIN_MASK) != 0 ) { BaudrateCode |= 0x02; }
+ if ( (*this->BAUDRATE_DIPSW.S0_Gpio.PIN & this->BAUDRATE_DIPSW.S0_Gpio.PIN_MASK) != 0 ) { BaudrateCode |= 0x01; }
+ 
+ switch (BaudrateCode)
+	{
+	 case (IDIBUS_BAUDRATE_DSW_CODE_2400B)   : { BaudrateCodeValue = 2400U;     break; }
+	 case (IDIBUS_BAUDRATE_DSW_CODE_9600B)   : { BaudrateCodeValue = 9600U;     break; }
+	 case (IDIBUS_BAUDRATE_DSW_CODE_19200B)  : { BaudrateCodeValue = 19200U;    break; }
+	 case (IDIBUS_BAUDRATE_DSW_CODE_115200B) : { BaudrateCodeValue = 115200U;   break; }
+	 case (IDIBUS_BAUDRATE_DSW_CODE_250K)    : { BaudrateCodeValue = 250000U;   break; }
+	 case (IDIBUS_BAUDRATE_DSW_CODE_500K)    : { BaudrateCodeValue = 500000U;   break; }
+	 case (IDIBUS_BAUDRATE_DSW_CODE_1M)      : { BaudrateCodeValue = 1000000U;  break; }
+	 case (IDIBUS_BAUDRATE_DSW_CODE_10M)     : { BaudrateCodeValue = 10000000U; break; }
+	 default : { return; }
+	}
+ if ( this->BAUDRATE != BaudrateCodeValue )
+	{
+	 this->SetBaudrateLL(BaudrateCodeValue);
+	 switch ( BaudrateCode )
+		{
+		 case (IDIBUS_BAUDRATE_DSW_CODE_2400B) : {
+			this->TimerInterFrameCompValue = (uint16_t)( ((uint64_t)IDIBUS_2400B_INTERFRAME_TIMEOUT_US      * (uint64_t)F_CPU / (uint64_t)IDIBUS_SERIAL_TIMER_PR_VALUE ) / 1000000ULL );
+			this->TimerTimeoutCompValue    = (uint16_t)( ((uint64_t)IDIBUS_2400B_MASTER_RESPONSE_TIMEOUT_US * (uint64_t)F_CPU  / (uint64_t)IDIBUS_SERIAL_TIMER_PR_VALUE) / 1000000ULL );
+			break; }
+		 case (IDIBUS_BAUDRATE_DSW_CODE_9600B) : {
+			this->TimerInterFrameCompValue = (uint16_t)( ((uint64_t)IDIBUS_9600B_INTERFRAME_TIMEOUT_US      * (uint64_t)F_CPU / (uint64_t)IDIBUS_SERIAL_TIMER_PR_VALUE ) / 1000000ULL );
+			this->TimerTimeoutCompValue    = (uint16_t)( ((uint64_t)IDIBUS_9600B_MASTER_RESPONSE_TIMEOUT_US * (uint64_t)F_CPU  / (uint64_t)IDIBUS_SERIAL_TIMER_PR_VALUE) / 1000000ULL );
+			break; }
+		 case (IDIBUS_BAUDRATE_DSW_CODE_19200B) : {
+			this->TimerInterFrameCompValue = (uint16_t)( ((uint64_t)IDIBUS_19200B_INTERFRAME_TIMEOUT_US      * (uint64_t)F_CPU / (uint64_t)IDIBUS_SERIAL_TIMER_PR_VALUE ) / 1000000ULL );
+			this->TimerTimeoutCompValue    = (uint16_t)( ((uint64_t)IDIBUS_19200B_MASTER_RESPONSE_TIMEOUT_US * (uint64_t)F_CPU  / (uint64_t)IDIBUS_SERIAL_TIMER_PR_VALUE) / 1000000ULL );
+			break; }
+		 case (IDIBUS_BAUDRATE_DSW_CODE_115200B) : {
+			this->TimerInterFrameCompValue = (uint16_t)( ((uint64_t)IDIBUS_115200B_INTERFRAME_TIMEOUT_US      * (uint64_t)F_CPU / (uint64_t)IDIBUS_SERIAL_TIMER_PR_VALUE ) / 1000000ULL );
+			this->TimerTimeoutCompValue    = (uint16_t)( ((uint64_t)IDIBUS_115200B_MASTER_RESPONSE_TIMEOUT_US * (uint64_t)F_CPU  / (uint64_t)IDIBUS_SERIAL_TIMER_PR_VALUE) / 1000000ULL );
+			break; }
+		 case (IDIBUS_BAUDRATE_DSW_CODE_250K) : { 
+			this->TimerInterFrameCompValue = (uint16_t)( ((uint64_t)IDIBUS_250K_INTERFRAME_TIMEOUT_US      * (uint64_t)F_CPU / (uint64_t)IDIBUS_SERIAL_TIMER_PR_VALUE ) / 1000000ULL );
+			this->TimerTimeoutCompValue    = (uint16_t)( ((uint64_t)IDIBUS_250K_MASTER_RESPONSE_TIMEOUT_US * (uint64_t)F_CPU  / (uint64_t)IDIBUS_SERIAL_TIMER_PR_VALUE) / 1000000ULL );
+			 break; }
+		 case (IDIBUS_BAUDRATE_DSW_CODE_500K) : {
+			this->TimerInterFrameCompValue = (uint16_t)( ((uint64_t)IDIBUS_500K_INTERFRAME_TIMEOUT_US      * (uint64_t)F_CPU / (uint64_t)IDIBUS_SERIAL_TIMER_PR_VALUE ) / 1000000ULL );
+			this->TimerTimeoutCompValue    = (uint16_t)( ((uint64_t)IDIBUS_500K_MASTER_RESPONSE_TIMEOUT_US * (uint64_t)F_CPU  / (uint64_t)IDIBUS_SERIAL_TIMER_PR_VALUE) / 1000000ULL );
+			break; }
+		 case (IDIBUS_BAUDRATE_DSW_CODE_1M) : {
+			this->TimerInterFrameCompValue = (uint16_t)( ((uint64_t)IDIBUS_1M_INTERFRAME_TIMEOUT_US      * (uint64_t)F_CPU / (uint64_t)IDIBUS_SERIAL_TIMER_PR_VALUE ) / 1000000ULL );
+			this->TimerTimeoutCompValue    = (uint16_t)( ((uint64_t)IDIBUS_1M_MASTER_RESPONSE_TIMEOUT_US * (uint64_t)F_CPU  / (uint64_t)IDIBUS_SERIAL_TIMER_PR_VALUE) / 1000000ULL );
+			break; }
+		 case (IDIBUS_BAUDRATE_DSW_CODE_10M) : {
+			this->TimerInterFrameCompValue = (uint16_t)( ((uint64_t)IDIBUS_10M_INTERFRAME_TIMEOUT_US      * (uint64_t)F_CPU / (uint64_t)IDIBUS_SERIAL_TIMER_PR_VALUE ) / 1000000ULL );
+			this->TimerTimeoutCompValue    = (uint16_t)( ((uint64_t)IDIBUS_10M_MASTER_RESPONSE_TIMEOUT_US * (uint64_t)F_CPU  / (uint64_t)IDIBUS_SERIAL_TIMER_PR_VALUE) / 1000000ULL );
+			break; }
+		 default : { return; }
+		}
+	}
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+void IdiBusSerial::SetBaudrateLL(uint32_t Baudrate)
+{
+ uint16_t UBRR_2X;
+ if ( ((F_CPU / 8U) % Baudrate) < (Baudrate / 2) )
+	{
+	 UBRR_2X = (uint16_t)( ((uint32_t)F_CPU / 8U) / Baudrate );		
+	 if ( UBRR_2X != 0 ) { UBRR_2X--; }
+	}
+	else { UBRR_2X = (uint16_t)( ((uint32_t)F_CPU / 16U) / Baudrate ); }	// WARNING CHANGED DIVIDER FROM 8 TO 16!!   //(F_CPU / 8U) / Baudrate + 1 - 1
+ *this->USARTN.UBRRN = UBRR_2X;
+ this->BAUDRATE = Baudrate;
+ if ( this->InitState == 1 ) { this->InitState = 2; }
+}
+//=============================================================================================================================================================================================================
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+//=============================================================================================================================================================================================================
+void IdiBusSerial::Start(void)
+{
+ *this->USARTN.UCSRNB = (1U<<USARTN_UCSRNB_TXEN_Pos) | (1U<<USARTN_UCSRNB_TXCIE_Pos);	// USART TX Periph enable
+ cli();
+ *this->RS485_DIR_GPIO.PORT |= this->RS485_DIR_GPIO.PIN_MASK;							// Dir to Tx
+ sei();
+ this->TransferComplete = 1;															//
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+void IdiBusSerial::Stop(void)
+{
+ *this->TIMN.TCCRNB = 0;											// Timer Stop
+ cli();
+ *this->RS485_DIR_GPIO.PORT &= ~this->RS485_DIR_GPIO.PIN_MASK;		// Dir to RX
+ sei();
+ *this->USARTN.UCSRNB = 0;											// USART TX/RX Periph disable
+ this->TransferComplete = 1;										// 
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+uint8_t IdiBusSerial::SendRequestAsync(uint8_t *_TxBuf_, uint16_t _TxBufLength_)
+{
+ if ( (this->TransferComplete == 0) || (this->InitState != 2) ) { return 0; }
+
+ this->ERROR_STATUS.SumVar = 0;
+ if		 ( _TxBufLength_ == 0 )						   { this->ERROR_STATUS.BF.TxZerolength = 1; return 0; }
+ else if ( _TxBufLength_ > IDIBUS_SERIAL_TX_BUF_SIZE ) { this->ERROR_STATUS.BF.TxOverflow = 1;   return 0; }
+ 	
+ memcpy(this->TxBuf, _TxBuf_, _TxBufLength_);
+ this->TransferComplete = 0;
+ this->RequestType = _IDIBUS_SERIAL_TX_RX_;
+ 
+ *this->TIMN.OCRNA = this->TimerInterFrameCompValue;
+ if ( this->TimerTimeoutCompValue > (0xFFFFU - this->TimerInterFrameCompValue) )
+	{
+	 *this->TIMN.OCRNB = 0xFFFFU;
+	 this->TimerTimeoutOverflow  = (uint16_t)( this->TimerTimeoutCompValue - (0xFFFFU - this->TimerInterFrameCompValue) );
+	}
+	else
+		{
+		 *this->TIMN.OCRNB = (uint16_t)(this->TimerTimeoutCompValue + this->TimerInterFrameCompValue);
+		 this->TimerTimeoutOverflow  = 0;
+		}
+ *this->TIMN.TCNTN = 0;
+ *this->TIMN.TIFRN  = (1U << USARTN_TIM_TIFR_OCFA_Pos)  | (1U << USARTN_TIM_TIFR_OCFB_Pos);		// Interframe and Response timeouts
+ *this->TIMN.TIMSKN = (1U << USRTN_TIM_TIMSK_OCIEA_Pos) | (1U << USRTN_TIM_TIMSK_OCIEB_Pos);		
+ 
+ this->TxBufCounter = 1;
+ this->TxBufLength = _TxBufLength_;
+ this->RxBufCounter = 0;
+ *this->USARTN.UDRN = this->TxBuf[0];
+ return 1;
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+uint8_t IdiBusSerial::SendRequestSync(uint8_t *_TxBuf_, uint16_t _TxBufLength_)
+{
+ if ( this->InitState != 2 ) { return 0; }
+ while ( this->TransferComplete == 0 ) { }
+ if ( this->SendRequestAsync(_TxBuf_, _TxBufLength_) == 0 ) { return 0; }
+ while ( this->TransferComplete == 0 ) { }
+ return 1;
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+uint8_t IdiBusSerial::WriteAsync(uint8_t *_TxBuf_, uint16_t _TxBufLength_)
+{
+ if ( (this->TransferComplete == 0) || (this->InitState != 2) ) { return 0; }
+ 
+ this->ERROR_STATUS.SumVar = 0;
+ if		 ( _TxBufLength_ == 0 )						   { this->ERROR_STATUS.BF.TxZerolength = 1; return 0; }
+ else if ( _TxBufLength_ > IDIBUS_SERIAL_TX_BUF_SIZE ) { this->ERROR_STATUS.BF.TxOverflow = 1;   return 0; }
+
+ this->TransferComplete = 0;	 
+ memcpy(this->TxBuf, _TxBuf_, _TxBufLength_);
+ this->RequestType = _IDIBUS_SERIAL_TX_;
+ 
+ *this->TIMN.OCRNA = this->TimerInterFrameCompValue;
+ *this->TIMN.TCNTN = 0;
+ *this->TIMN.TIFRN  = (1U << USARTN_TIM_TIFR_OCFA_Pos) | (1U << USARTN_TIM_TIFR_OCFB_Pos);		// Interframe Timeout
+ *this->TIMN.TIMSKN = (1U << USRTN_TIM_TIMSK_OCIEA_Pos);
+ 	
+ this->TxBufCounter = 1;
+ this->TxBufLength = _TxBufLength_;
+ *this->USARTN.UDRN = this->TxBuf[0];
+ return 1;
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+uint8_t IdiBusSerial::WriteSync(uint8_t *_TxBuf_, uint16_t _TxBufLength_)
+{
+ if ( this->InitState != 2 ) { return 0; }
+ while ( this->TransferComplete == 0 ) {}
+ if ( this->WriteAsync(_TxBuf_, _TxBufLength_) == 0 ) { return 0; }
+ while ( this->TransferComplete == 0 ) {}
+ return 1;
+}
+//=============================================================================================================================================================================================================
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+//=============================================================================================================================================================================================================
+uint8_t *IdiBusSerial::getTxBufPointer(void)
+{
+ if ( this->TransferComplete ) { return this->TxBuf; }
+ else                          { return NULL; }
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+uint8_t *IdiBusSerial::getRxBufPointer (void)
+{
+ return this->RxBuf;	
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+uint8_t IdiBusSerial::SendRequestAsync(uint16_t DataLength)
+{
+ if ( (this->TransferComplete == 0) || (this->InitState != 2) ) { return 0; }
+ this->ERROR_STATUS.SumVar = 0;
+ this->TransferComplete = 0;
+ this->RequestType = _IDIBUS_SERIAL_TX_RX_;
+ 
+ *this->TIMN.OCRNA = this->TimerInterFrameCompValue;
+ if ( this->TimerTimeoutCompValue > (0xFFFFU - this->TimerInterFrameCompValue) )
+	{
+	 *this->TIMN.OCRNB = 0xFFFFU;
+	 this->TimerTimeoutOverflow  = (uint16_t)( this->TimerTimeoutCompValue - (0xFFFFU - this->TimerInterFrameCompValue) );
+	}
+	else
+		{
+		 *this->TIMN.OCRNB = (uint16_t)(this->TimerTimeoutCompValue + this->TimerInterFrameCompValue);
+		 this->TimerTimeoutOverflow  = 0;
+		}
+ *this->TIMN.TCNTN = 0;
+ *this->TIMN.TIFRN  = (1U << USARTN_TIM_TIFR_OCFA_Pos)  | (1U << USARTN_TIM_TIFR_OCFB_Pos);		// Interframe and Response timeouts
+ *this->TIMN.TIMSKN = (1U << USRTN_TIM_TIMSK_OCIEA_Pos) | (1U << USRTN_TIM_TIMSK_OCIEB_Pos);		
+ 
+ this->TxBufCounter = 1;
+ this->TxBufLength = DataLength;
+ this->RxBufCounter = 0;
+ *this->USARTN.UDRN = this->TxBuf[0];
+ return 1;
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+uint8_t IdiBusSerial::SendRequestSync(uint16_t DataLength)
+{
+ if ( this->InitState != 2 ) { return 0; }
+ while ( this->TransferComplete == 0 ) {}
+ if ( this->SendRequestAsync(DataLength) == 0 ) { return 0; }
+ while ( this->TransferComplete == 0 ) {}
+ return 1;
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+uint8_t IdiBusSerial::WriteAsync(uint16_t DataLength)
+{
+ if ( (this->TransferComplete == 0) || (this->InitState != 2) ) { return 0; }
+ this->ERROR_STATUS.SumVar = 0;
+ this->TransferComplete = 0;	 
+ this->RequestType = _IDIBUS_SERIAL_TX_;
+ 
+ *this->TIMN.OCRNA = this->TimerInterFrameCompValue;
+ *this->TIMN.TCNTN = 0;
+ *this->TIMN.TIFRN  = (1U << USARTN_TIM_TIFR_OCFA_Pos) | (1U << USARTN_TIM_TIFR_OCFB_Pos);		// Interframe Timeout
+ *this->TIMN.TIMSKN = (1U << USRTN_TIM_TIMSK_OCIEA_Pos);
+ 	
+ this->TxBufCounter = 1;
+ this->TxBufLength = DataLength;
+ *this->USARTN.UDRN = this->TxBuf[0];
+ return 1;
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+uint8_t IdiBusSerial::WriteSync(uint16_t DataLength)
+{
+  if ( this->InitState != 2 ) { return 0; }
+ while ( this->TransferComplete == 0 ) {}
+ if ( this->WriteAsync(DataLength) == 0 ) { return 0; }
+ while ( this->TransferComplete == 0 ) {}
+ return 1;
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+uint8_t  IdiBusSerial::IsTransferComplete(void) { return this->TransferComplete; }
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+uint16_t IdiBusSerial::GetRxBufCounter(void) { return this->RxBufCounter; }
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+IDIBUS_SERIAL_ERROR_STATUS_TYPE IdiBusSerial::GetErrorStatus(void) { return this->ERROR_STATUS; }
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+uint32_t IdiBusSerial::GetBaudrate(void) { return this->BAUDRATE; }
+//=============================================================================================================================================================================================================
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+//=============================================================================================================================================================================================================
+void IdiBusSerial::USART_RxInterruptFunc (void)
+{
+ *this->TIMN.TCNTN = 0;
+ if ( (*this->USARTN.UCSRNA & ( (1U<<USARTN_UCSRNA_FE_Pos)|(1U<<USARTN_UCSRNA_DOR_Pos)|(1U<<USARTN_UCSRNA_UPE_Pos)) ) == 0 )
+	{
+	 if ( this->RxBufCounter < IDIBUS_SERIAL_RX_BUF_SIZE ) { this->RxBuf[this->RxBufCounter++] = *this->USARTN.UDRN; }
+	 else												   { this->ERROR_STATUS.BF.RxOverflow = 1; (void)*this->USARTN.UDRN; }
+	}
+	else { this->ERROR_STATUS.BF.LLComERR = 1; (void)*this->USARTN.UDRN; }
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+void IdiBusSerial::USART_TxInterruptFunc (void)
+{
+ if ( this->TxBufCounter != this->TxBufLength ) { *this->USARTN.UDRN  = this->TxBuf[this->TxBufCounter++]; }
+ else
+	{
+	 switch (this->RequestType)
+		{
+		 case (_IDIBUS_SERIAL_TX_RX_) : {
+			*this->RS485_DIR_GPIO.PORT &= ~this->RS485_DIR_GPIO.PIN_MASK;
+			*this->USARTN.UCSRNB |= (1U<<USARTN_UCSRNB_RXEN_Pos) | (1U<<USARTN_UCSRNB_RXCIE_Pos);
+			*this->TIMN.TCCRNB = IDIBUS_SERIAL_TIMER_PR_REG;				//Timer Start
+			break; }
+		 case (_IDIBUS_SERIAL_TX_) : {
+			*this->TIMN.TCCRNB = IDIBUS_SERIAL_TIMER_PR_REG;				//Timer Start		
+			break; }
+		}
+	 }
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+void IdiBusSerial::TIM_COMPA_InterruptFunc (void)
+{
+ switch (this->RequestType)
+	{
+	 case ( _IDIBUS_SERIAL_TX_RX_  ) : {
+			 if ( this->RxBufCounter != 0 )	// Interframe Timeout < Response < Request Timeout
+				{
+				 *this->TIMN.TCCRNB = 0;																		// Timer Stop
+				 *this->USARTN.UCSRNB &= ~( (1U<<USARTN_UCSRNB_RXEN_Pos) | (1U<<USARTN_UCSRNB_RXCIE_Pos) );		// Rx Periph Stop
+				 *this->RS485_DIR_GPIO.PORT |= this->RS485_DIR_GPIO.PIN_MASK;									// Dir to TX
+				 this->TransferComplete = 1;																	// Complete
+				}
+			break; }
+	 case (_IDIBUS_SERIAL_TX_) : { 
+			*this->TIMN.TCCRNB = 0;				// Timer Stop
+			this->TransferComplete = 1;			// Complete
+			break; }
+	}
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+void IdiBusSerial::TIM_COMPB_InterruptFunc (void)
+{
+ if ( this->TimerTimeoutOverflow != 0 )
+	{
+	 *this->TIMN.OCRNB = this->TimerTimeoutOverflow;
+	 *this->TIMN.TCNTN = 0;
+	 *this->TIMN.TIFRN = (1U << USARTN_TIM_TIFR_OCFB_Pos);
+	 this->TimerTimeoutOverflow = 0;
+	}
+	else
+		{
+		 *this->TIMN.TCCRNB = 0;				//Timer Stop
+		 *this->USARTN.UCSRNB &= ~( (1U<<USARTN_UCSRNB_RXEN_Pos) | (1U<<USARTN_UCSRNB_RXCIE_Pos) );
+		 *this->RS485_DIR_GPIO.PORT |= this->RS485_DIR_GPIO.PIN_MASK;
+		 this->ERROR_STATUS.BF.TimeoutERR = 1;
+		 this->TransferComplete = 1;
+		}
+}
+//=============================================================================================================================================================================================================
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+//=============================================================================================================================================================================================================
+uint8_t IdiBusSerial::GetGpioParams(IDIBUS_SERIAL_GPIO_INIT *InitSTR, IDIBUS_SERIAL_GPIO *gpio)
+{
+ if ( InitSTR->PIN_NUM > 7 ) { return 0; }
+ 
+ if		 ( (uint16_t)InitSTR->PORT == (uint16_t)&PORTA ) { gpio->PORT = &PORTA; gpio->DDR = &DDRA; gpio->PIN = &PINA; }
+ else if ( (uint16_t)InitSTR->PORT == (uint16_t)&PORTB ) { gpio->PORT = &PORTB; gpio->DDR = &DDRB; gpio->PIN = &PINB; }
+ else if ( (uint16_t)InitSTR->PORT == (uint16_t)&PORTC ) { gpio->PORT = &PORTC; gpio->DDR = &DDRC; gpio->PIN = &PINC; }
+ else if ( (uint16_t)InitSTR->PORT == (uint16_t)&PORTD ) { gpio->PORT = &PORTD; gpio->DDR = &DDRD; gpio->PIN = &PIND; }
+ else if ( (uint16_t)InitSTR->PORT == (uint16_t)&PORTE ) { gpio->PORT = &PORTE; gpio->DDR = &DDRE; gpio->PIN = &PINE; }
+ else if ( (uint16_t)InitSTR->PORT == (uint16_t)&PORTF ) { gpio->PORT = &PORTF; gpio->DDR = &DDRF; gpio->PIN = &PINF; }
+ else if ( (uint16_t)InitSTR->PORT == (uint16_t)&PORTG ) { gpio->PORT = &PORTG; gpio->DDR = &DDRG; gpio->PIN = &PING; }
+ else if ( (uint16_t)InitSTR->PORT == (uint16_t)&PORTH ) { gpio->PORT = &PORTH; gpio->DDR = &DDRH; gpio->PIN = &PINH; }
+ else if ( (uint16_t)InitSTR->PORT == (uint16_t)&PORTJ ) { gpio->PORT = &PORTJ; gpio->DDR = &DDRJ; gpio->PIN = &PINJ; }
+ else if ( (uint16_t)InitSTR->PORT == (uint16_t)&PORTK ) { gpio->PORT = &PORTK; gpio->DDR = &DDRK; gpio->PIN = &PINK; }
+ else if ( (uint16_t)InitSTR->PORT == (uint16_t)&PORTL ) { gpio->PORT = &PORTL; gpio->DDR = &DDRL; gpio->PIN = &PINL; }
+ else													 { return 0; }
+ gpio->PIN_MASK = (0x01U << InitSTR->PIN_NUM);
+ return 1;
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+uint8_t IdiBusSerial::GetGpioParamsArduino(uint8_t PinNum, IDIBUS_SERIAL_GPIO *gpio)
+{
+ uint8_t PortCode;
+ if ( (PinNum >= NUM_DIGITAL_PINS) || ((PortCode = digitalPinToPort(PinNum)) == NOT_A_PIN) ) { return 0; }
+ gpio->PIN_MASK = digitalPinToBitMask(PinNum); 
+ gpio->PORT     = portOutputRegister(PortCode);
+ gpio->DDR      = portModeRegister(PortCode);
+ gpio->PIN      = portInputRegister(PortCode);
+ return 1;
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+//#############################################################################################################################################################################################################

libraries/idiBusMaster/src/IdiBusSerial.h

@@ -0,0 +1,123 @@
+//#############################################################################################################################################################################################################
+#ifndef _IDIBUS_SERIAL_H_
+#define _IDIBUS_SERIAL_H_
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+#include "IdiBusSystem.h"
+#include "IdiBusSerialDefs.h"
+#include "IdiBusInterruptsList.h"
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+enum IDIBUS_SERIAL_USARTN_NUMBER {
+	IDIBUS_SERIAL_USART0,
+	IDIBUS_SERIAL_USART1,
+	IDIBUS_SERIAL_USART2,
+	IDIBUS_SERIAL_USART3
+	};
+enum IDIBUS_SERIAL_TIMER_NUMBER {
+	IDIBUS_TIMER_1 = 1,
+	IDIBUS_TIMER_3 = 3,
+	IDIBUS_TIMER_4,
+	IDIBUS_TIMER_5
+	};
+enum IDIBUS_SERIAL_USARTN_CONFIG {
+	IDIBUS_SERIAL_8N1,
+	IDIBUS_SERIAL_8N2,
+	IDIBUS_SERIAL_8E1,
+	IDIBUS_SERIAL_8E2,
+	IDIBUS_SERIAL_8O1,
+	IDIBUS_SERIAL_8O2
+	};
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+typedef struct {
+	enum IDIBUS_SERIAL_USARTN_NUMBER   USART_NUMBER;
+	enum IDIBUS_SERIAL_TIMER_NUMBER    TIMER_NUMBER;
+	enum IDIBUS_SERIAL_USARTN_CONFIG   CONFIG;
+	uint8_t							   RS485_DIR_PIN;
+	uint8_t							   BAUDRATE_DIPSW_S0_PIN;
+	uint8_t							   BAUDRATE_DIPSW_S1_PIN;
+	uint8_t							   BAUDRATE_DIPSW_S2_PIN;
+	} IDIBUS_SERIAL_INIT_TYPEDEF;
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+typedef struct {
+	enum IDIBUS_SERIAL_USARTN_NUMBER   USART_NUMBER;
+	enum IDIBUS_SERIAL_TIMER_NUMBER    TIMER_NUMBER;
+	enum IDIBUS_SERIAL_USARTN_CONFIG   CONFIG;
+	IDIBUS_SERIAL_GPIO_INIT			   RS485_DIR_GPIO;
+	struct {
+		IDIBUS_SERIAL_GPIO_INIT		   S0;
+		IDIBUS_SERIAL_GPIO_INIT		   S1;
+		IDIBUS_SERIAL_GPIO_INIT		   S2;
+		}							   BAUDRATE_DIPSW;
+	} IDIBUS_SERIAL_ALTERNATIVE_INIT_TYPEDEF;	
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+class IdiBusSerial : public IdiBusCallbackInterface {
+	
+	public :
+		IdiBusSerial(void);
+		
+		uint8_t								Init(IDIBUS_SERIAL_INIT_TYPEDEF *InitT);
+		uint8_t								Init(IDIBUS_SERIAL_ALTERNATIVE_INIT_TYPEDEF *InitT);
+		void								SetBaudrate(enum IDIBUS_SERIAL_BAUDRATE Baudrate);
+		void								UpdateBaudrateFromDipSwitch(void);
+		
+		void								Start (void);				// Hold Line
+		void								Stop (void);				// TX/RX disable, Release Line
+		
+		uint8_t								SendRequestAsync(uint8_t *_TxBuf_, uint16_t _TxBufLength_);
+		uint8_t								SendRequestSync (uint8_t *_TxBuf_, uint16_t _TxBufLength_);
+
+		uint8_t								WriteSync (uint8_t *_TxBuf_, uint16_t _TxBufLength_);
+		uint8_t								WriteAsync(uint8_t *_TxBuf_, uint16_t _TxBufLength_);
+		
+		uint8_t								IsTransferComplete(void);
+		uint16_t							GetRxBufCounter(void);
+		IDIBUS_SERIAL_ERROR_STATUS_TYPE		GetErrorStatus(void);
+		uint32_t							GetBaudrate(void);
+		
+	private :
+		IDIBUS_SERIAL_USART_HW_TYPE			USARTN;
+		IDIBUS_SERIAL_USARTN_16BIT_TIMER	TIMN;
+		
+		IDIBUS_SERIAL_GPIO					RS485_DIR_GPIO;
+		IDIBUS_SERIAL_BAUDRATE_DIPSW_TYPE	BAUDRATE_DIPSW;
+		uint32_t							BAUDRATE;
+		
+		uint8_t								TxBuf[IDIBUS_SERIAL_TX_BUF_SIZE];
+		uint16_t							TxBufLength;
+		uint16_t							TxBufCounter;
+		
+		uint8_t								RxBuf[IDIBUS_SERIAL_RX_BUF_SIZE];
+		uint16_t							RxBufCounter;
+		IDIBUS_SERIAL_ERROR_STATUS_TYPE		ERROR_STATUS;
+
+		uint16_t							TimerInterFrameCompValue;
+		uint16_t                            TimerTimeoutCompValue;
+		uint16_t							TimerTimeoutOverflow;
+		
+		enum IDIBUS_SERIAL_REQUEST_TYPE		RequestType;
+		volatile uint8_t					TransferComplete;
+		uint16_t						    InitProtectionVar;
+		uint8_t  						    InitState;
+		
+		// Interrupt Vectors Pointers
+		virtual void USART_RxInterruptFunc(void)   override;
+		virtual void USART_TxInterruptFunc(void)   override;
+		virtual void TIM_COMPA_InterruptFunc(void) override;
+		virtual void TIM_COMPB_InterruptFunc(void) override;
+		
+		// Routine
+		uint8_t BaseInit(enum IDIBUS_SERIAL_USARTN_NUMBER USART_NUM, enum IDIBUS_SERIAL_TIMER_NUMBER TIMER_NUM, enum IDIBUS_SERIAL_USARTN_CONFIG CONF);
+		uint8_t GetGpioParams(IDIBUS_SERIAL_GPIO_INIT *InitSTR, IDIBUS_SERIAL_GPIO *gpio);
+		uint8_t GetGpioParamsArduino(uint8_t PinNum, IDIBUS_SERIAL_GPIO *gpio);
+		void    SetBaudrateLL(uint32_t Baudrate);
+	
+	protected :
+		uint8_t *getTxBufPointer (void);
+		uint8_t *getRxBufPointer (void);
+		uint8_t  SendRequestAsync(uint16_t DataLength);
+		uint8_t  SendRequestSync(uint16_t DataLength);
+		uint8_t  WriteAsync(uint16_t DataLength);
+		uint8_t  WriteSync(uint16_t DataLength);
+};
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+#endif //_IDIBUS_SERIAL_H_
+//#############################################################################################################################################################################################################

libraries/idiBusMaster/src/IdiBusSerialDefs.h

@@ -0,0 +1,138 @@
+//#############################################################################################################################################################################################################
+#ifndef _IDIBUS_SERIAL_COMDEFS_H_
+#define _IDIBUS_SERIAL_COMDEFS_H_
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+#include "IdiBusSystem.h"
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+#if defined (__AVR_ATmega2560__)
+#define USARTN_UCSRNA_RXC_Pos					7U
+#define USARTN_UCSRNA_TXC_Pos					6U
+#define USARTN_UCSRNA_UDR_Pos					5U
+#define USARTN_UCSRNA_FE_Pos					4U
+#define USARTN_UCSRNA_DOR_Pos					3U
+#define USARTN_UCSRNA_UPE_Pos					2U
+#define USARTN_UCSRNA_U2X_Pos					1U
+#define USARTN_UCSRNA_MPCM_Pos					0U
+
+#define USARTN_UCSRNB_RXCIE_Pos					7U
+#define USARTN_UCSRNB_TXCIE_Pos					6U		
+#define USARTN_UCSRNB_UDRIE_Pos					5U
+#define USARTN_UCSRNB_RXEN_Pos					4U
+#define USARTN_UCSRNB_TXEN_Pos					3U
+#define USARTN_UCSRNB_UCSZ2_Pos					2U
+#define USARTN_UCSRNB_RXB8_Pos					1U
+#define USARTN_UCSRNB_TXB8_Pos					0U
+
+#define USARTN_UCSRNC_UMSEL1					7U
+#define USARTN_UCSRNC_UMSEL0					6U	
+#define USARTN_UCSRNC_UPM1						5U
+#define USARTN_UCSRNC_UPM0						4U
+#define USARTN_UCSRNC_USBS						3U
+#define USARTN_UCSRNC_UCSZ1						2U
+#define USARTN_UCSRNC_UCSZ0						1U
+#define USARTN_UCSRNC_UCPOL						0U
+
+#define USARTN_TIM_TCCRA_WGMN1_Pos				1U
+
+#define USARTN_TIM_TCCRB_PR1					1U
+#define USARTN_TIM_TCCRB_PR8					2U
+#define USARTN_TIM_TCCRB_PR64					3U
+#define USARTN_TIM_TCCRB_PR256					4U
+#define USARTN_TIM_TCCRB_PR1024					5U
+
+#define USRTN_TIM_TIMSK_TOIE_Pos				0U
+#define USRTN_TIM_TIMSK_OCIEA_Pos				1U
+#define USRTN_TIM_TIMSK_OCIEB_Pos				2U
+#define USRTN_TIM_TIMSK_OCIEC_Pos				3U
+
+#define USARTN_TIM_TIFR_TOV_Pos					0U
+#define USARTN_TIM_TIFR_OCFA_Pos				1U
+#define USARTN_TIM_TIFR_OCFB_Pos				2U
+#define USARTN_TIM_TIFR_OCFC_Pos				3U
+
+#endif //#if defined (__AVR_ATmega2560__)
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+#define IDIBUS_BAUDRATE_DSW_CODE_19200B			0x00
+#define IDIBUS_BAUDRATE_DSW_CODE_500K			0x01
+#define IDIBUS_BAUDRATE_DSW_CODE_2400B			0x02
+#define IDIBUS_BAUDRATE_DSW_CODE_9600B			0x03
+#define IDIBUS_BAUDRATE_DSW_CODE_115200B		0x04
+#define IDIBUS_BAUDRATE_DSW_CODE_250K			0x05
+#define IDIBUS_BAUDRATE_DSW_CODE_1M				0x06
+#define IDIBUS_BAUDRATE_DSW_CODE_10M			0x07
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+#define IDIBUS_SERIAL_TIMER_PR_REG				USARTN_TIM_TCCRB_PR64
+
+#if   IDIBUS_SERIAL_TIMER_PR_REG == USARTN_TIM_TCCRB_PR1
+#define IDIBUS_SERIAL_TIMER_PR_VALUE			1U
+#elif IDIBUS_SERIAL_TIMER_PR_REG == USARTN_TIM_TCCRB_PR8
+#define IDIBUS_SERIAL_TIMER_PR_VALUE			8U
+#elif IDIBUS_SERIAL_TIMER_PR_REG == USARTN_TIM_TCCRB_PR64
+#define IDIBUS_SERIAL_TIMER_PR_VALUE			64U
+#elif IDIBUS_SERIAL_TIMER_PR_REG == USARTN_TIM_TCCRB_PR256
+#define IDIBUS_SERIAL_TIMER_PR_VALUE			256U
+#elif IDIBUS_SERIAL_TIMER_PR_REG == USARTN_TIM_TCCRB_PR1024
+#define IDIBUS_SERIAL_TIMER_PR_VALUE			1024U
+#else
+#error "Idibus Serial: Incorrect Timer Prescaler value !"
+#endif			//#if IDIBUS_T_CPU==CPU_ATmega2560
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+#define IDIBUS_SERIAL_TX_BUF_SIZE				IDIMMES_MAX_MES_SIZE
+#define IDIBUS_SERIAL_RX_BUF_SIZE				IDISMES_MAX_MES_SIZE
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+enum IDIBUS_SERIAL_REQUEST_TYPE {
+	_IDIBUS_SERIAL_TX_RX_,
+	_IDIBUS_SERIAL_TX_,
+	//Alarm
+	};
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+typedef struct {
+	volatile uint8_t  *UCSRNA;
+	volatile uint8_t  *UCSRNB;
+	volatile uint8_t  *UCSRNC;
+	volatile uint16_t *UBRRN;
+	volatile uint8_t  *UDRN;
+	} IDIBUS_SERIAL_USART_HW_TYPE;
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+typedef struct {
+	volatile uint8_t  *TCCRNA;
+	volatile uint8_t  *TCCRNB;
+	volatile uint8_t  *TIMSKN;
+	volatile uint8_t  *TIFRN;
+	volatile uint16_t *OCRNA;
+	volatile uint16_t *OCRNB;
+	volatile uint16_t *TCNTN;
+	} IDIBUS_SERIAL_USARTN_16BIT_TIMER;
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+typedef union {
+	uint8_t SumVar;
+	struct {
+		uint8_t TimeoutERR : 1;
+		uint8_t TxOverflow : 1;
+		uint8_t RxOverflow : 1;
+		uint8_t LLComERR   : 1;
+		uint8_t TxZerolength : 1;
+		uint8_t Reserved   : 3;
+		} BF;
+	} IDIBUS_SERIAL_ERROR_STATUS_TYPE;
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+typedef struct {
+	uint8_t			  PIN_MASK;
+	volatile uint8_t *PORT;
+	volatile uint8_t *DDR;
+	volatile uint8_t *PIN;
+	} IDIBUS_SERIAL_GPIO;
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+typedef struct {
+	uint8_t			  PIN_NUM;
+	volatile uint8_t *PORT;
+	} IDIBUS_SERIAL_GPIO_INIT;
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+typedef	struct {
+	IDIBUS_SERIAL_GPIO S0_Gpio;
+	IDIBUS_SERIAL_GPIO S1_Gpio;
+	IDIBUS_SERIAL_GPIO S2_Gpio;
+	} IDIBUS_SERIAL_BAUDRATE_DIPSW_TYPE;
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+#endif //_IDIBUS_SERIAL_COMDEFS_H_
+//#############################################################################################################################################################################################################

libraries/idiBusMaster/src/IdiBusSerialLine.cpp

@@ -0,0 +1,122 @@
+//#############################################################################################################################################################################################################
+#include "IdiBusSerialLine.h"
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+IdiBusSerialLine::IdiBusSerialLine(void) : IdiBusSerial()
+{
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+uint8_t IdiBusSerialLine::sendMMES (IdiBusMMES *MMES)
+{
+ if ( MMES->IsValid() == 0 ) { return IDIERMST_INVALID_TX_REQUEST_FORMAT; }
+ 
+ uint8_t *TxMesBuf = this->getTxBufPointer();
+ if ( TxMesBuf == NULL ) { return IDIERMST_TX_MES; }
+ 
+ uint8_t *RxMesBuf = this->getRxBufPointer();
+ uint16_t DataPos;
+
+ // Fill Header
+ TxMesBuf[IDIMMES_ADDR_Pos] =  MMES->SlAddr;
+ TxMesBuf[IDIMMES_MMPS_Pos] = (MMES->MMPS.LongMes          << IDIMMES_MMPS_LONG_MES_Pos)    |
+						      (IDIMMES_MMPS_MES_TYPE_MMES  << IDIMMES_MMPS_MES_TYPE_Pos)    | 
+							  (0x00U                       << IDIMMES_MMPS_FAST_FUNC_Pos)   |
+							  (MMES->MMPS.AlarmMes         << IDIMMES_MMPS_ALARM_FRAME_Pos) | 
+							  (MMES->MMPS.EncryptedAes     << IDIMMES_MMPS_ENCRYPTED_AES_Pos); 
+ TxMesBuf[IDIMMES_DEV_Pos]  = (MMES->DEV.NUM << IDIMMES_DEV_NUM_Pos)   | (MMES->DEV.ALLCH << IDIMMES_DEV_ALLCH_Pos);
+ TxMesBuf[IDIMMES_CHNL_Pos] = (MMES->CHNL.NUM << IDIMMES_CHNL_NUM_Pos) | (MMES->CHNL.ALLSAME << IDIMMES_CHNL_ALLSAME_Pos);
+ DataPos = IDIMMES_CHNL_Pos + 1;
+
+ // If Not Fast Function add command/function
+ if ( MMES->ComFunc < 16 ) { TxMesBuf[IDIMMES_MMPS_Pos] |= (MMES->ComFunc << IDIMMES_MMPS_FAST_FUNC_Pos); }
+ else                      { TxMesBuf[DataPos++] = MMES->ComFunc; }
+ 
+ // Fill Data
+ if ( MMES->TxDataLength != 0 ) { memcpy(&TxMesBuf[DataPos], &MMES->TxData[0], MMES->TxDataLength); }
+ 
+ // Add CRC
+ uint16_t CRC = MODBUS_CRC16::CRC16_TF(&TxMesBuf[0], (uint16_t)(DataPos + MMES->TxDataLength));
+ TxMesBuf[DataPos + MMES->TxDataLength]     = (uint8_t)(CRC >> 8);
+ TxMesBuf[DataPos + MMES->TxDataLength + 1] = (uint8_t) CRC;
+ 
+ if ( this->SendRequestSync(DataPos + MMES->TxDataLength + MODBUS_CRC16_SIZE) == 0 ) { return IDIERMST_TX_MES; }
+			 
+ IDIBUS_SERIAL_ERROR_STATUS_TYPE SerialError = this->GetErrorStatus();
+ uint16_t RxMessageLength;
+ 
+ if      ( SerialError.BF.TimeoutERR != 0 )                                                                    { return IDIERMST_RCV_TIMEOUT; }
+ else if ( (SerialError.SumVar != 0) || ((RxMessageLength = this->GetRxBufCounter()) < IDISMES_MIN_MES_SIZE) ) { return IDIERMST_MES_RX_INTEGRITY;   }
+ else
+	{
+	 uint16_t CRC = MODBUS_CRC16::CRC16_TF( &RxMesBuf[0], (uint16_t)(RxMessageLength-MODBUS_CRC16_SIZE) );
+	 uint16_t ReceivedCRC = ((uint16_t)RxMesBuf[RxMessageLength-2] << 8) | RxMesBuf[RxMessageLength-1];
+	 if      ( CRC != ReceivedCRC )							{ return IDIERMST_CRC; }
+	 else if ( RxMesBuf[IDISMES_ADDR_Pos] != MMES->SlAddr ) { return IDIERMST_INVALID_ADDR_NUM; }
+	 else
+		{
+		 MMES->RxDataLength = RxMessageLength - (IDISMES_ERROR_Pos + MODBUS_CRC16_SIZE);
+		 MMES->RxData = &RxMesBuf[IDISMES_ERROR_Pos];
+		 return IDIER_NOPE;
+		}
+	}
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+uint8_t IdiBusSerialLine::sendMMESG (IdiBusMMESG *MMESG)
+{
+ if ( MMESG->IsValid() == 0 ) { return IDIERMST_INVALID_TX_REQUEST_FORMAT ; }
+
+ uint8_t *TxMesBuf = this->getTxBufPointer();
+ if ( TxMesBuf == NULL ) { return IDIERMST_TX_MES; }
+ 
+ uint8_t *RxMesBuf = this->getRxBufPointer();
+ uint16_t DataPos;
+ 
+ // Fill Header
+ TxMesBuf[IDIMMES_ADDR_Pos] =  MMESG->SlAddr;
+ TxMesBuf[IDIMMES_MMPS_Pos] = (MMESG->MMPS.LongMes         << IDIMMES_MMPS_LONG_MES_Pos)    |
+						      (IDIMMES_MMPS_MES_TYPE_MMESG << IDIMMES_MMPS_MES_TYPE_Pos)    | 
+							  (0x00	                      << IDIMMES_MMPS_FAST_FUNC_Pos)    |
+							  (MMESG->MMPS.AlarmMes        << IDIMMES_MMPS_ALARM_FRAME_Pos) | 
+							  (MMESG->MMPS.EncryptedAes    << IDIMMES_MMPS_ENCRYPTED_AES_Pos);
+ DataPos = IDIMMES_MMPS_Pos + 1;
+ // If Not Fast Function add command/function
+ if ( MMESG->ComFunc < 16 ) { TxMesBuf[IDIMMES_MMPS_Pos] |= (MMESG->ComFunc << IDIMMES_MMPS_FAST_FUNC_Pos); }
+ else                       { TxMesBuf[DataPos++] = MMESG->ComFunc; }
+
+ // Fill Data
+ if ( MMESG->TxDataLength != 0 ) { memcpy(&TxMesBuf[DataPos], &MMESG->TxData[0], MMESG->TxDataLength); }
+ 
+ // Add CRC
+ uint16_t CRC = MODBUS_CRC16::CRC16_TF(&TxMesBuf[0], (uint16_t)(DataPos + MMESG->TxDataLength));
+ TxMesBuf[DataPos + MMESG->TxDataLength]     = (uint8_t)(CRC >> 8);
+ TxMesBuf[DataPos + MMESG->TxDataLength + 1] = (uint8_t) CRC;
+ 
+ if ( MMESG->IsGroupAddr() != 0 )
+	{
+	 if ( this->WriteSync(DataPos + MMESG->TxDataLength + MODBUS_CRC16_SIZE) == 0 ) { return IDIERMST_TX_MES; }
+	 return IDIER_NOPE;
+	}
+	else //Module commands
+		{
+		 if ( this->SendRequestSync(DataPos + MMESG->TxDataLength + MODBUS_CRC16_SIZE) == 0 ) { return IDIERMST_TX_MES; }
+			 
+		 uint16_t RxMessageLength;
+		 IDIBUS_SERIAL_ERROR_STATUS_TYPE SerialError = this->GetErrorStatus();
+		 
+		 if      ( SerialError.BF.TimeoutERR != 0 )                                                                     { return IDIERMST_RCV_TIMEOUT; }
+		 else if ( (SerialError.SumVar != 0) || ((RxMessageLength = this->GetRxBufCounter()) < IDISMES_MIN_MES_SIZE) )  { return IDIERMST_TX_MES; }
+		 else
+			{
+			 uint16_t CRC = MODBUS_CRC16::CRC16_TF( &RxMesBuf[0], (uint16_t)(RxMessageLength-MODBUS_CRC16_SIZE) );
+			 uint16_t ReceivedCRC = ((uint16_t)RxMesBuf[RxMessageLength-2] << 8) | RxMesBuf[RxMessageLength-1];
+			 if      ( CRC != ReceivedCRC )							 { return IDIERMST_CRC; }
+			 else if ( RxMesBuf[IDISMES_ADDR_Pos] != MMESG->SlAddr ) { return IDIERMST_INVALID_ADDR_NUM; }
+				{
+				 MMESG->RxDataLength = RxMessageLength - (IDISMES_ERROR_Pos + MODBUS_CRC16_SIZE);
+				 MMESG->RxData = &RxMesBuf[IDISMES_ERROR_Pos];
+				 return IDIER_NOPE;
+				}
+			}
+ 		}
+}
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+//#############################################################################################################################################################################################################