code to work with the gyro and accel

Here is basic code for a bit of filtering and working with the mpu 6050