Modified MobilizedBody::lock() and lockAt() methods to immediately modify q and/or u in the state to satisfy the requested lock, rather than waiting until the next prescribe() call.

This satisfies Kevin He's request in Simbody issue #20.
Merge pull request #23 from sherm1/master

Modified MobilizedBody::lock() and lockAt() methods to immediately modify state.