You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
23 lines
646 B
23 lines
646 B
#
|
|
# Copyright 2022 Philipp Schönberger - mail@phschoen.de
|
|
#
|
|
# This program is distributed in the hope that it will be useful,
|
|
# but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
# MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
# GNU General Public License for more details.
|
|
#
|
|
# See <http://www.gnu.org/licenses/>.
|
|
function [org] = calc_finger_pos(angles,trans,translate)
|
|
{
|
|
org = [0,0,0];
|
|
org = org + [0,0,trans];
|
|
|
|
org = [0,0,translate(1)] + org;
|
|
org = org * rotx(angles(1));
|
|
|
|
org = [0,0,translate(2)] + org;
|
|
org = org * rotx(angles(2));
|
|
|
|
org = [0,0,translate(3)] + org;
|
|
org = org * rotx(angles(3));
|
|
}
|