Added controller node, trajectory generator, completed projection node