A monolithic optimal control method for displacement tracking of Cosserat rod with application to reconstruction of C. elegans locomotion