Added several new tests, mainly pole balancing