CAN working, velocity calculation weird.