MC-Basic:IsLocationReachable

From SoftMC-Wiki
Revision as of 10:32, 7 March 2021 by Miborich (talk | contribs)
Jump to: navigation, search
Language: English

Checks the given point if it is reachable by the given robot. Checks both Cartesian and joint limits.

Input parameters:

<Robot>
name of the group for which the direct kinematics is computed, when a WITH command is executed this argument is not needed (the comma should also be omitted).
<Location>
location coordinates of the point to be translated into joint coordinates.
<configuration>
integer describing the configuration of the returned joint position (for SCARA it is the same as ARMCMD or ARMFBK).

The number and type of configuration flags depend on each robot type. Note that robot properties ARMCMD, ECMD, WCMD have all three values(0, 1, 2), where 0 is reserved for AUTO option. The configuration bits however have only two values (0, 1).

for SCARA robot
Arm (Bit 0)
value = 0 – Lefty (armcd = 1)
value = 1 – Righty (armcmd = 2)
for PUMA robot 
Arm (Bit 0)
value = 0 – Lefty (armcd = 1)
value = 1 – Righty (armcmd = 2)
Elbow (Bit 1)
value = 0 – Below (ecmd = 1)
value = 1 – Above (ecmd = 2)
Wrist (Bit 2)
value = 0 - Noflip (wcmd = 1)
value = 1 – Flip (wcmd = 2)
for TRAVERSEARM robot
Arm ( Bit 0)
value = 0 – Lefty (armcd = 1)
value = 1 – Righty (armcmd = 2)

for DELTA, SCISSORS, … and other robots, that have no configuration flags, these fields are not used.

The configuration flag argument of the IsLocationReachable is defined as:
ISREACHABLEBITS.PNG


NOTE-Info.svgNOTE
In this function we can notuse "AUTO" option, therefore this formula differ slightly from bitmap in TOJOINT
NOTE-Info.svgNOTE
Constants lefty, righty, above, below, flip and noflip are defined as built-in constants of the MC-Basic language.

Syntax

<joint_variable>=IsLocationReachable(<Robot>, <location>, <configuration>)

Availability

Since Version 3.7.x

Type

Return Type: Long

0 - point is reachable
1,2,3,4,... - index of axis that exceed position limits
Other - system error, basically there is no single axis that exceeds limit but the combination of segment length and input cartesian point does not have solution of Inverse Kinematics

Scope

Task, Terminal

Limitations

  • Not in Configuration context.
  • The joint variable and the location parameter must either have a group type identical to the group parameter, or have the same number of coordinates.
  • The values of the configuration argument (the long type parameter) can be only: 0, 1 or 2, with the same meaning as ARMCMD.

See Also