Algorithm And Programming In Robotics