Began working on ros_control EPOS node