it exists aleady (Score 1)

Check out NASA's CLARAty reusable (open-source) robotics framework http://claraty.jpl.nasa.gov/man/overview/index.php Why reinvent the wheel. Who knows maybe your work developing this code will help send robots to other planets.