Add source code HCR_2014 robotics by HuyLe