Added support for 25MHz and setPin function

Library still only works on PORT1