nuttx-apps/examples/pwfb/pwfb_motion.c

366 lines
11 KiB
C

/****************************************************************************
* examples/pwfb/pwfb_motion.c
*
* Copyright (C) 2019 Gregory Nutt. All rights reserved.
* Author: Gregory Nutt <gnutt@nuttx.org>
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
*
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in
* the documentation and/or other materials provided with the
* distribution.
* 3. Neither the name NuttX nor the names of its contributors may be
* used to endorse or promote products derived from this software
* without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
* FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
* COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
* BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
* OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
* AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
* ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
* POSSIBILITY OF SUCH DAMAGE.
*
****************************************************************************/
/****************************************************************************
* Included Files
****************************************************************************/
#include <nuttx/config.h>
#include <stdio.h>
#include <stdbool.h>
#include <errno.h>
#include <nuttx/nx/nxglib.h>
#include <nuttx/nx/nxcursor.h>
#include <nuttx/nx/nxtk.h>
#include "pwfb_internal.h"
/****************************************************************************
* Private Functions
****************************************************************************/
/****************************************************************************
* Name: pwfb_move_window
****************************************************************************/
#if CONFIG_EXAMPLES_PWFB_NWINDOWS > 0
static inline bool pwfb_move_window(FAR struct pwfb_state_s *st, int wndx)
{
FAR struct pwfb_window_s *wndo = &st->wndo[wndx];
FAR struct nxgl_point_s pos;
b16_t newx;
b16_t newy;
bool hit = false;
int ret;
#ifdef CONFIG_EXAMPLES_PWFB_VERBOSE
printf("pwfb_move_window: Velocity: (%lx.%04lx,%lx.%04lx)\n",
(unsigned long)wndo->deltax >> 16,
(unsigned long)wndo->deltax & 0xffff,
(unsigned long)wndo->deltay >> 16,
(unsigned long)wndo->deltay & 0xffff);
printf("pwfb_move_window: Max: (%lx.%04lx,%lx.%04lx)\n",
(unsigned long)wndo->xmax >> 16,
(unsigned long)wndo->xmax & 0xffff,
(unsigned long)wndo->ymax >> 16,
(unsigned long)wndo->ymax & 0xffff);
#endif
/* Update X position */
newx = wndo->xpos + wndo->deltax;
/* Check for collision with left or right side */
if (newx <= 0)
{
newx = 0;
wndo->deltax = -wndo->deltax;
hit = true;
}
else if (newx >= wndo->xmax)
{
newx = wndo->xmax;
wndo->deltax = -wndo->deltax;
hit = true;
}
/* Update Y position */
newy = wndo->ypos + wndo->deltay;
/* Check for collision with top or bottom side */
if (newy <= 0)
{
newy = 0;
wndo->deltay = -wndo->deltay;
hit = true;
}
else if (newy >= wndo->ymax)
{
newy = wndo->ymax;
wndo->deltay = -wndo->deltay;
hit = true;
}
#ifdef CONFIG_EXAMPLES_PWFB_VERBOSE
printf("pwfb_move_window: Old pos: (%lx.%04lx,%lx.%04lx) "
"New pos: (%lx.%04lx,%lx.%04lx)\n",
(unsigned long)wndo->xpos >> 16,
(unsigned long)wndo->xpos & 0xffff,
(unsigned long)wndo->ypos >> 16,
(unsigned long)wndo->ypos & 0xffff,
(unsigned long)newx >> 16,
(unsigned long)newx & 0xffff,
(unsigned long)newy >> 16,
(unsigned long)newy & 0xffff);
#endif
/* Set the new window position */
wndo->xpos = newx;
wndo->ypos = newy;
pos.x = b16toi(newx);
pos.y = b16toi(newy);
printf("pwfb_move_window: Set position (%d,%d)\n", pos.x, pos.y);
ret = nxtk_setposition(wndo->hwnd, &pos);
if (ret < 0)
{
printf("pwfb_move_window: ERROR:"
"nxtk_setposition failed: %d\n",
errno);
return false;
}
/* If we hit an edge, the raise the window */
if (hit)
{
#ifdef CONFIG_EXAMPLES_PWFB_VERBOSE
printf("pwfb_move_window: New velocity: (%lx.%04lx,%lx.%04lx)\n",
(unsigned long)wndo->deltax >> 16,
(unsigned long)wndo->deltax & 0xffff,
(unsigned long)wndo->deltay >> 16,
(unsigned long)wndo->deltay & 0xffff);
printf("pwfb_move_window: Raising window\n");
#endif
ret = nxtk_raise(wndo->hwnd);
if (ret < 0)
{
printf("pwfb_move_window: ERROR:"
"nxtk_raise failed: %d\n",
errno);
return false;
}
}
return true;
}
#endif
/****************************************************************************
* Name: pwfb_move_cursor
****************************************************************************/
#ifdef CONFIG_NX_SWCURSOR
static inline bool pwfb_move_cursor(FAR struct pwfb_state_s *st)
{
FAR struct nxgl_point_s pos;
b16_t newx;
b16_t newy;
int ret;
#ifdef CONFIG_EXAMPLES_PWFB_VERBOSE
printf("pwfb_move_cursor: State: %u countdown: %u blinktime: %u\n",
(unsigned int)st->cursor.state, (unsigned int)st->cursor.countdown,
(unsigned int)st->cursor.blinktime;
printf("pwfb_move_cursor: Velocity: (%lx.%04lx,%lx.%04lx)\n",
(unsigned long)st->cursor.deltax >> 16,
(unsigned long)st->cursor.deltax & 0xffff,
(unsigned long)st->cursor.deltay >> 16,
(unsigned long)st->cursor.deltay & 0xffff);
#endif
/* Handle the update based on cursor state */
/* If the state is not PFWB_CURSOR_STATIONARY, then update the cursor
* position.
*/
if (st->cursor.state != PFWB_CURSOR_STATIONARY)
{
/* Update X position */
newx = st->cursor.xpos + st->cursor.deltax;
/* Check for collision with left or right side */
if (newx <= 0)
{
newx = 0;
st->cursor.deltax = -st->cursor.deltax;
}
else if (newx >= st->cursor.xmax)
{
newx = st->cursor.xmax;
st->cursor.deltax = -st->cursor.deltax;
}
/* Update Y position */
newy = st->cursor.ypos + st->cursor.deltay;
/* Check for collision with top or bottom side */
if (newy <= 0)
{
newy = 0;
st->cursor.deltay = -st->cursor.deltay;
}
else if (newy >= st->cursor.ymax)
{
newy = st->cursor.ymax;
st->cursor.deltay = -st->cursor.deltay;
}
#ifdef CONFIG_EXAMPLES_PWFB_VERBOSE
printf("pwfb_move_cursor: Old pos: (%lx.%04lx,%lx.%04lx) "
"New pos: (%lx.%04lx,%lx.%04lx)\n",
(unsigned long)st->cursor.xpos >> 16,
(unsigned long)st->cursor.xpos & 0xffff,
(unsigned long)st->cursor.ypos >> 16,
(unsigned long)st->cursor.ypos & 0xffff,
(unsigned long)newx >> 16,
(unsigned long)newx & 0xffff,
(unsigned long)newy >> 16,
(unsigned long)newy & 0xffff);
#endif
/* Set the new cursor position */
st->cursor.xpos = newx;
st->cursor.ypos = newy;
pos.x = b16toi(newx);
pos.y = b16toi(newy);
printf("pwfb_move_cursor: Set position (%d,%d)\n", pos.x, pos.y);
ret = nxcursor_setposition(st->hnx, &pos);
if (ret < 0)
{
printf("nxcursor_setposition: ERROR:"
"nxcursor_setposition failed: %d\n",
errno);
return false;
}
}
/* Check for state changes */
switch (st->cursor.state)
{
case PFWB_CURSOR_MOVING:
if (--st->cursor.countdown <= 0)
{
/* Set up for the the STATIONARY state next */
st->cursor.state = PFWB_CURSOR_STATIONARY;
st->cursor.countdown = CURSOR_STATIONARY_DELAY;
}
break;
case PFWB_CURSOR_STATIONARY:
if (--st->cursor.countdown <= 0)
{
/* Set up for the the BLINKING state next */
st->cursor.state = PFWB_CURSOR_BLINKING;
st->cursor.countdown = CURSOR_BLINKING_DELAY;
st->cursor.blinktime = CURSOR_BLINK_DELAY;
}
break;
case PFWB_CURSOR_BLINKING:
if (--st->cursor.countdown <= 0)
{
/* Set up for the the MOVING state next */
st->cursor.state = PFWB_CURSOR_MOVING;
st->cursor.countdown = CURSOR_MOVING_DELAY;
st->cursor.visible = true;
nxcursor_enable(st->hnx, true);
}
else if (--st->cursor.blinktime <= 0)
{
/* Toggle visibility */
st->cursor.blinktime = CURSOR_BLINK_DELAY;
st->cursor.visible = !st->cursor.visible;
nxcursor_enable(st->hnx, st->cursor.visible);
}
}
return true;
}
#endif
/****************************************************************************
* Public Functions
****************************************************************************/
/****************************************************************************
* Name: pwfb_motion
****************************************************************************/
bool pwfb_motion(FAR struct pwfb_state_s *st)
{
#if CONFIG_EXAMPLES_PWFB_NWINDOWS > 0
int wndx;
/* Move each window */
for (wndx = 0; wndx < CONFIG_EXAMPLES_PWFB_NWINDOWS; wndx++)
{
if (!pwfb_move_window(st, wndx))
{
printf("pwfb_motion: ERROR:"
"pwfb_move_window failed for window %d\n",
wndx + 1);
}
}
#endif
#ifdef CONFIG_NX_SWCURSOR
/* Move the cursor */
if (!pwfb_move_cursor(st))
{
printf("pwfb_motion: ERROR: pwfb_move_cursor failed\n");
}
#endif
return true;
}