Create imu.c

Main flish control system file for MIPS