Simple RRT navigation using the HOAP-3 robot head as the COG

Movement plannification of the Center of Gravity of the humanoid HOAP-3 in a structured environment. The trajectory has been obtained using Rapidly-exploring Random Trees (RRTs) and then smoothed with splines.