So I guess I was scratching my head for 15 hours because I need a second power source for the servos...
6 servos, 2 RGB lights an Arduino Micro and a Ping Sensor cant run on one 9v 170mAh battery, plus I learned the ins and outs of ChibiOS
Thanks for the help