Added joints, added some functionality to the controller. Very buggy, will need to refactor in the near future.