Menu
Measuring Tilt using a Three Axis Solution
In order to define the angles of the accelerometer in three dimensions the pitch, roll and theta are sensed using all three outputs of the accelerometer. Pitch (ρ) is defined as the angle of the X-axis relative to ground. Roll (ϕ) is defined as the angle of the Y-axis relative to the ground. Theta (θ) is the angle of the Z axis relative to gravity.
http://www.freescale.com/files/senso...ote/AN3461.pdf
Here is the meat of the code:
Code:
solveangle:
'**********Solve for x angle ********************************************
if xresult < yresult + zresult then
dummy = 5000 'when x is smaller the following equation works best
xlong = (dummy * xresult) /(sqr((yresult*yresult) + (zresult*zresult)))
else 'keeps results accurate at near 0 and near 90 degree values
dummy =30 'when x is larger the following equation works best
xlong = (dummy * xresult*xresult) / ((yresult*yresult)+(zresult*zresult))
endif
y = xlong
x = dummy 'Assign x and y values for atan2 function
call atan2
xangle = 9000 - y
if yresult < xresult + zresult then
dummy = 5000 'when y is smaller the following eqauation works best
ylong = (dummy * yresult) / (sqr((xresult*xresult) + (zresult*zresult)))
else
dummy =30 'when y is larger the following equation works best
ylong = (dummy * yresult*yresult) / ((xresult*xresult)+(zresult*zresult))
endif
y = ylong
x = dummy '
call atan2
yangle = 9000 - y
16F18446 - setting baudrate for HW EUSART
Thanks a lot Richard.
flotulopex Today, 17:30All your settings work like a charm :wink:
Still a question: why would one choose the 8 bit baudrate generator - seems less accurate, no?