Hey guys, it worked! I deleted the AHRS initialization and it worked. The only other thing is that there is this other error message that I wasn't seeing cause it was drowned out by the first. It is this:
Code:
Error on line 143 of Command.cpp: A pointer parameter to a method is NULL: subsystem
at /home/lvuser/FRCUserProgram() [0x38884]
at /home/lvuser/FRCUserProgram() [0x1b078]
at /home/lvuser/FRCUserProgram() [0x17b34]
at /home/lvuser/FRCUserProgram() [0x1f6f4]
at /home/lvuser/FRCUserProgram() [0x16b78]
at /home/lvuser/FRCUserProgram() [0x1fa88]
at /home/lvuser/FRCUserProgram() [0x20ca8]
at /home/lvuser/FRCUserProgram() [0x16acc]
at __libc_start_main
Would you know what might be causing this?