Compass debug

Fixed up rosparam call to make sure biases are being pulled in properly. Tested on Kingfisher. 
Fix style please, on this line and the one above.