Changes model to always take input and output in body frame.  Adds wrapper functions around model to convert to and from drake frame.