Kinmap Update

This is an update to the arduino sketch. Use kinmap.ino for now, still need to complete arduino_DUE_130129.ino