More or less working. Need to fix velocity.