Now stomp optimizes integral of cost
Can now load motions