Added gravity and drag forces. Some debugging stuff