Added update_{vspeed/hspeed} and finished implementing direction