plotting done

next step is to close the loops
unstable controllers at the moment