Initial controller implemented. The robot is capable of escaping the given ditch through a 'jumping' motion.