Added Servo and timer compatibility, Cube Detection