Fixed buttons and updated sensor config

YAH. Not tested, especially since we don't have a working robot... ;P