Removed un-needed brackets
Removed unneeded radius variables
Added some debug