Added collision avoidance force. Also added keys 1 thru 4 for toggling forces