Added pins for Megatronics v2.0, Keypad code optimized