Test programs for robocup cospace rescue written in C. Most of these programs are working proof-of-concepts. They could be used to enhance the robots navigation capabilities. concepts implemented: dijkstras shortest path, pseudo odometry, differential robot kinematics, go-to-goal controller.