Our Robotic Arm code to sort colored blocks