more changes

still won't calculate velocity and position (various debugging data
displayed)