Winning code for ”Takashi’s Castle” Autonomous Robotics Competition at the Cadence Innovation Con- ference, India. Code includes end to end pipeline for strategy, control and decision-making algorithms.