Update floor_control.c