Step function and corresponding test seem to be working for pendulum. Still need to test that the pendulum will eventually fall over
Added javadoc to the JBLAS library