The setInitDisp function can't be used in the wecSimInputFile.m without first defining a body's cg. Since the cg of the body is read from the H5 file after the input file is called, this function can't be used properly.

Manually setting the body.initDisp maxtrix is limited in that any rotation is defined about the cg and not any other point.

We should modify this function so that it can be used in the input file, without defining a cg that will go on to be overwritten when calling wecSim.m