Design and simulation of control algorithms for stored energy and plasma current in non-inductive scenarios on NSTX-U