Fixed input timing but in beluga sim node
Address 1/tan in theta=0 case in beluga model
Added n_robots argument. Now published correct # of states