Compass debug

Fixed up rosparam call to make sure biases are being pulled in properly. Tested on Kingfisher. 
Sorry, took care of it myself just now.