Added MPU lib. Prelim. Not done.
Added some I/O logic; reorganized header

also fixed up some TWI stuff :) . Includes reset logic.