working gyro and accel(need some tweaking), PRU cape not applying