Fixed errors.... should be working now

There were errors in most of the methods. Using 4 cubes as a test case,
I believe most of the errors are out.