High-Speed Accurate Robot Control using Learned Forward Kinodynamics and Non-linear Least Squares Optimization