Fixed jiter of servos, fixed some memory-stuff