iforce2d Chris
Displays distance to start location on OLED screen.
Diff: u8g_rot.c
- Revision:
- 0:972874f31c98
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/u8g_rot.c Wed Mar 07 12:49:14 2018 +0000
@@ -0,0 +1,405 @@
+/*
+
+ u8g_rot.c
+
+ Universal 8bit Graphics Library
+
+ Copyright (c) 2011, olikraus@gmail.com
+ All rights reserved.
+
+ Redistribution and use in source and binary forms, with or without modification,
+ are permitted provided that the following conditions are met:
+
+ * Redistributions of source code must retain the above copyright notice, this list
+ of conditions and the following disclaimer.
+
+ * 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.
+
+ 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 HOLDER 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.
+
+
+*/
+
+#include "u8g.h"
+
+uint8_t u8g_dev_rot90_fn(u8g_t *u8g, u8g_dev_t *dev, uint8_t msg, void *arg);
+uint8_t u8g_dev_rot180_fn(u8g_t *u8g, u8g_dev_t *dev, uint8_t msg, void *arg);
+uint8_t u8g_dev_rot270_fn(u8g_t *u8g, u8g_dev_t *dev, uint8_t msg, void *arg);
+
+u8g_dev_t u8g_dev_rot = { u8g_dev_rot90_fn, NULL, NULL };
+
+
+void u8g_UndoRotation(u8g_t *u8g)
+{
+ if ( u8g->dev != &u8g_dev_rot )
+ return;
+ u8g->dev = u8g_dev_rot.dev_mem;
+ u8g_UpdateDimension(u8g);
+}
+
+void u8g_SetRot90(u8g_t *u8g)
+{
+ if ( u8g->dev != &u8g_dev_rot )
+ {
+ u8g_dev_rot.dev_mem = u8g->dev;
+ u8g->dev = &u8g_dev_rot;
+ }
+ u8g_dev_rot.dev_fn = u8g_dev_rot90_fn;
+ u8g_UpdateDimension(u8g);
+}
+
+void u8g_SetRot180(u8g_t *u8g)
+{
+ if ( u8g->dev != &u8g_dev_rot )
+ {
+ u8g_dev_rot.dev_mem = u8g->dev;
+ u8g->dev = &u8g_dev_rot;
+ }
+ u8g_dev_rot.dev_fn = u8g_dev_rot180_fn;
+ u8g_UpdateDimension(u8g);
+}
+
+void u8g_SetRot270(u8g_t *u8g)
+{
+ if ( u8g->dev != &u8g_dev_rot )
+ {
+ u8g_dev_rot.dev_mem = u8g->dev;
+ u8g->dev = &u8g_dev_rot;
+ }
+ u8g_dev_rot.dev_fn = u8g_dev_rot270_fn;
+ u8g_UpdateDimension(u8g);
+}
+
+uint8_t u8g_dev_rot90_fn(u8g_t *u8g, u8g_dev_t *dev, uint8_t msg, void *arg)
+{
+ u8g_dev_t *rotation_chain = (u8g_dev_t *)(dev->dev_mem);
+ switch(msg)
+ {
+ default:
+ /*
+ case U8G_DEV_MSG_INIT:
+ case U8G_DEV_MSG_STOP:
+ case U8G_DEV_MSG_PAGE_FIRST:
+ case U8G_DEV_MSG_PAGE_NEXT:
+ case U8G_DEV_MSG_SET_COLOR_ENTRY:
+ case U8G_DEV_MSG_SET_XY_CB:
+ */
+ return u8g_call_dev_fn(u8g, rotation_chain, msg, arg);
+#ifdef U8G_DEV_MSG_IS_BBX_INTERSECTION
+ case U8G_DEV_MSG_IS_BBX_INTERSECTION:
+ {
+ u8g_dev_arg_bbx_t *bbx = (u8g_dev_arg_bbx_t *)arg;
+ u8g_uint_t x, y, tmp;
+
+ /* transform the reference point */
+ y = bbx->x;
+ x = u8g->height;
+ /* x = u8g_GetWidthLL(u8g, rotation_chain); */
+ x -= bbx->y;
+ x--;
+
+ /* adjust point to be the uppler left corner again */
+ x -= bbx->h;
+ x++;
+
+ /* swap box dimensions */
+ tmp = bbx->w;
+ bbx->w = bbx->h;
+ bbx->h = tmp;
+
+ /* store x,y */
+ bbx->x = x;
+ bbx->y = y;
+ }
+ return u8g_call_dev_fn(u8g, rotation_chain, msg, arg);
+#endif /* U8G_DEV_MSG_IS_BBX_INTERSECTION */
+ case U8G_DEV_MSG_GET_PAGE_BOX:
+ /* get page size from next device in the chain */
+ u8g_call_dev_fn(u8g, rotation_chain, msg, arg);
+ //printf("pre x: %3d..%3d y: %3d..%3d ", ((u8g_box_t *)arg)->x0, ((u8g_box_t *)arg)->x1, ((u8g_box_t *)arg)->y0, ((u8g_box_t *)arg)->y1);
+ {
+ u8g_box_t new_box;
+ //new_box.x0 = u8g_GetHeightLL(u8g,rotation_chain) - ((u8g_box_t *)arg)->y1 - 1;
+ //new_box.x1 = u8g_GetHeightLL(u8g,rotation_chain) - ((u8g_box_t *)arg)->y0 - 1;
+
+ new_box.x0 = ((u8g_box_t *)arg)->y0;
+ new_box.x1 = ((u8g_box_t *)arg)->y1;
+ new_box.y0 = ((u8g_box_t *)arg)->x0;
+ new_box.y1 = ((u8g_box_t *)arg)->x1;
+ *((u8g_box_t *)arg) = new_box;
+ //printf("post x: %3d..%3d y: %3d..%3d\n", ((u8g_box_t *)arg)->x0, ((u8g_box_t *)arg)->x1, ((u8g_box_t *)arg)->y0, ((u8g_box_t *)arg)->y1);
+ }
+ break;
+ case U8G_DEV_MSG_GET_WIDTH:
+ *((u8g_uint_t *)arg) = u8g_GetHeightLL(u8g,rotation_chain);
+ break;
+ case U8G_DEV_MSG_GET_HEIGHT:
+ *((u8g_uint_t *)arg) = u8g_GetWidthLL(u8g, rotation_chain);
+ break;
+ case U8G_DEV_MSG_SET_PIXEL:
+ case U8G_DEV_MSG_SET_TPIXEL:
+ {
+ u8g_uint_t x, y;
+ y = ((u8g_dev_arg_pixel_t *)arg)->x;
+ x = u8g_GetWidthLL(u8g, rotation_chain);
+ x -= ((u8g_dev_arg_pixel_t *)arg)->y;
+ x--;
+ ((u8g_dev_arg_pixel_t *)arg)->x = x;
+ ((u8g_dev_arg_pixel_t *)arg)->y = y;
+ }
+ u8g_call_dev_fn(u8g, rotation_chain, msg, arg);
+ break;
+ case U8G_DEV_MSG_SET_8PIXEL:
+ case U8G_DEV_MSG_SET_4TPIXEL:
+ {
+ u8g_uint_t x, y;
+ //uint16_t x,y;
+ y = ((u8g_dev_arg_pixel_t *)arg)->x;
+ x = u8g_GetWidthLL(u8g, rotation_chain);
+ x -= ((u8g_dev_arg_pixel_t *)arg)->y;
+ x--;
+ ((u8g_dev_arg_pixel_t *)arg)->x = x;
+ ((u8g_dev_arg_pixel_t *)arg)->y = y;
+ ((u8g_dev_arg_pixel_t *)arg)->dir+=1;
+ ((u8g_dev_arg_pixel_t *)arg)->dir &= 3;
+ }
+ u8g_call_dev_fn(u8g, rotation_chain, msg, arg);
+ break;
+ }
+ return 1;
+}
+
+uint8_t u8g_dev_rot180_fn(u8g_t *u8g, u8g_dev_t *dev, uint8_t msg, void *arg)
+{
+ u8g_dev_t *rotation_chain = (u8g_dev_t *)(dev->dev_mem);
+ switch(msg)
+ {
+ default:
+ /*
+ case U8G_DEV_MSG_INIT:
+ case U8G_DEV_MSG_STOP:
+ case U8G_DEV_MSG_PAGE_FIRST:
+ case U8G_DEV_MSG_PAGE_NEXT:
+ case U8G_DEV_MSG_SET_COLOR_ENTRY:
+ case U8G_DEV_MSG_SET_XY_CB:
+ */
+ return u8g_call_dev_fn(u8g, rotation_chain, msg, arg);
+#ifdef U8G_DEV_MSG_IS_BBX_INTERSECTION
+ case U8G_DEV_MSG_IS_BBX_INTERSECTION:
+ {
+ u8g_dev_arg_bbx_t *bbx = (u8g_dev_arg_bbx_t *)arg;
+ u8g_uint_t x, y;
+
+ /* transform the reference point */
+ //y = u8g_GetHeightLL(u8g, rotation_chain);
+ y = u8g->height;
+ y -= bbx->y;
+ y--;
+
+ //x = u8g_GetWidthLL(u8g, rotation_chain);
+ x = u8g->width;
+ x -= bbx->x;
+ x--;
+
+ /* adjust point to be the uppler left corner again */
+ y -= bbx->h;
+ y++;
+
+ x -= bbx->w;
+ x++;
+
+ /* store x,y */
+ bbx->x = x;
+ bbx->y = y;
+ }
+ return u8g_call_dev_fn(u8g, rotation_chain, msg, arg);
+#endif /* U8G_DEV_MSG_IS_BBX_INTERSECTION */
+ case U8G_DEV_MSG_GET_PAGE_BOX:
+ /* get page size from next device in the chain */
+ u8g_call_dev_fn(u8g, rotation_chain, msg, arg);
+ //printf("pre x: %3d..%3d y: %3d..%3d ", ((u8g_box_t *)arg)->x0, ((u8g_box_t *)arg)->x1, ((u8g_box_t *)arg)->y0, ((u8g_box_t *)arg)->y1);
+ {
+ u8g_box_t new_box;
+
+ new_box.x0 = u8g_GetWidthLL(u8g,rotation_chain) - ((u8g_box_t *)arg)->x1 - 1;
+ new_box.x1 = u8g_GetWidthLL(u8g,rotation_chain) - ((u8g_box_t *)arg)->x0 - 1;
+ new_box.y0 = u8g_GetHeightLL(u8g,rotation_chain) - ((u8g_box_t *)arg)->y1 - 1;
+ new_box.y1 = u8g_GetHeightLL(u8g,rotation_chain) - ((u8g_box_t *)arg)->y0 - 1;
+ *((u8g_box_t *)arg) = new_box;
+ //printf("post x: %3d..%3d y: %3d..%3d\n", ((u8g_box_t *)arg)->x0, ((u8g_box_t *)arg)->x1, ((u8g_box_t *)arg)->y0, ((u8g_box_t *)arg)->y1);
+ }
+ break;
+ case U8G_DEV_MSG_GET_WIDTH:
+ *((u8g_uint_t *)arg) = u8g_GetWidthLL(u8g,rotation_chain);
+ break;
+ case U8G_DEV_MSG_GET_HEIGHT:
+ *((u8g_uint_t *)arg) = u8g_GetHeightLL(u8g, rotation_chain);
+ break;
+ case U8G_DEV_MSG_SET_PIXEL:
+ case U8G_DEV_MSG_SET_TPIXEL:
+ {
+ u8g_uint_t x, y;
+
+ y = u8g_GetHeightLL(u8g, rotation_chain);
+ y -= ((u8g_dev_arg_pixel_t *)arg)->y;
+ y--;
+
+ x = u8g_GetWidthLL(u8g, rotation_chain);
+ x -= ((u8g_dev_arg_pixel_t *)arg)->x;
+ x--;
+
+ ((u8g_dev_arg_pixel_t *)arg)->x = x;
+ ((u8g_dev_arg_pixel_t *)arg)->y = y;
+ }
+ u8g_call_dev_fn(u8g, rotation_chain, msg, arg);
+ break;
+ case U8G_DEV_MSG_SET_8PIXEL:
+ case U8G_DEV_MSG_SET_4TPIXEL:
+ {
+ u8g_uint_t x, y;
+
+ y = u8g_GetHeightLL(u8g, rotation_chain);
+ y -= ((u8g_dev_arg_pixel_t *)arg)->y;
+ y--;
+
+ x = u8g_GetWidthLL(u8g, rotation_chain);
+ x -= ((u8g_dev_arg_pixel_t *)arg)->x;
+ x--;
+
+ ((u8g_dev_arg_pixel_t *)arg)->x = x;
+ ((u8g_dev_arg_pixel_t *)arg)->y = y;
+ ((u8g_dev_arg_pixel_t *)arg)->dir+=2;
+ ((u8g_dev_arg_pixel_t *)arg)->dir &= 3;
+ }
+ u8g_call_dev_fn(u8g, rotation_chain, msg, arg);
+ break;
+ }
+ return 1;
+}
+
+uint8_t u8g_dev_rot270_fn(u8g_t *u8g, u8g_dev_t *dev, uint8_t msg, void *arg)
+{
+ u8g_dev_t *rotation_chain = (u8g_dev_t *)(dev->dev_mem);
+ switch(msg)
+ {
+ default:
+ /*
+ case U8G_DEV_MSG_INIT:
+ case U8G_DEV_MSG_STOP:
+ case U8G_DEV_MSG_PAGE_FIRST:
+ case U8G_DEV_MSG_PAGE_NEXT:
+ case U8G_DEV_MSG_SET_COLOR_ENTRY:
+ case U8G_DEV_MSG_SET_XY_CB:
+ */
+ return u8g_call_dev_fn(u8g, rotation_chain, msg, arg);
+#ifdef U8G_DEV_MSG_IS_BBX_INTERSECTION
+ case U8G_DEV_MSG_IS_BBX_INTERSECTION:
+ {
+ u8g_dev_arg_bbx_t *bbx = (u8g_dev_arg_bbx_t *)arg;
+ u8g_uint_t x, y, tmp;
+
+ /* transform the reference point */
+ x = bbx->y;
+
+ y = u8g->width;
+ /* y = u8g_GetHeightLL(u8g, rotation_chain); */
+ y -= bbx->x;
+ y--;
+
+ /* adjust point to be the uppler left corner again */
+ y -= bbx->w;
+ y++;
+
+ /* swap box dimensions */
+ tmp = bbx->w;
+ bbx->w = bbx->h;
+ bbx->h = tmp;
+
+ /* store x,y */
+ bbx->x = x;
+ bbx->y = y;
+ }
+ return u8g_call_dev_fn(u8g, rotation_chain, msg, arg);
+#endif /* U8G_DEV_MSG_IS_BBX_INTERSECTION */
+ case U8G_DEV_MSG_GET_PAGE_BOX:
+ /* get page size from next device in the chain */
+ u8g_call_dev_fn(u8g, rotation_chain, msg, arg);
+ //printf("pre x: %3d..%3d y: %3d..%3d ", ((u8g_box_t *)arg)->x0, ((u8g_box_t *)arg)->x1, ((u8g_box_t *)arg)->y0, ((u8g_box_t *)arg)->y1);
+ {
+ u8g_box_t new_box;
+
+ new_box.x0 = u8g_GetHeightLL(u8g,rotation_chain) - ((u8g_box_t *)arg)->y1 - 1;
+ new_box.x1 = u8g_GetHeightLL(u8g,rotation_chain) - ((u8g_box_t *)arg)->y0 - 1;
+ new_box.y0 = u8g_GetWidthLL(u8g,rotation_chain) - ((u8g_box_t *)arg)->x1 - 1;
+ new_box.y1 = u8g_GetWidthLL(u8g,rotation_chain) - ((u8g_box_t *)arg)->x0 - 1;
+ *((u8g_box_t *)arg) = new_box;
+ //printf("post x: %3d..%3d y: %3d..%3d\n", ((u8g_box_t *)arg)->x0, ((u8g_box_t *)arg)->x1, ((u8g_box_t *)arg)->y0, ((u8g_box_t *)arg)->y1);
+ }
+ break;
+ case U8G_DEV_MSG_GET_WIDTH:
+ *((u8g_uint_t *)arg) = u8g_GetHeightLL(u8g,rotation_chain);
+ break;
+ case U8G_DEV_MSG_GET_HEIGHT:
+ *((u8g_uint_t *)arg) = u8g_GetWidthLL(u8g, rotation_chain);
+ break;
+ case U8G_DEV_MSG_SET_PIXEL:
+ case U8G_DEV_MSG_SET_TPIXEL:
+ {
+ u8g_uint_t x, y;
+ x = ((u8g_dev_arg_pixel_t *)arg)->y;
+
+ y = u8g_GetHeightLL(u8g, rotation_chain);
+ y -= ((u8g_dev_arg_pixel_t *)arg)->x;
+ y--;
+
+ /*
+ x = u8g_GetWidthLL(u8g, rotation_chain);
+ x -= ((u8g_dev_arg_pixel_t *)arg)->y;
+ x--;
+ */
+ ((u8g_dev_arg_pixel_t *)arg)->x = x;
+ ((u8g_dev_arg_pixel_t *)arg)->y = y;
+ }
+ u8g_call_dev_fn(u8g, rotation_chain, msg, arg);
+ break;
+ case U8G_DEV_MSG_SET_8PIXEL:
+ case U8G_DEV_MSG_SET_4TPIXEL:
+ {
+ u8g_uint_t x, y;
+ x = ((u8g_dev_arg_pixel_t *)arg)->y;
+
+ y = u8g_GetHeightLL(u8g, rotation_chain);
+ y -= ((u8g_dev_arg_pixel_t *)arg)->x;
+ y--;
+
+ /*
+ x = u8g_GetWidthLL(u8g, rotation_chain);
+ x -= ((u8g_dev_arg_pixel_t *)arg)->y;
+ x--;
+ */
+ ((u8g_dev_arg_pixel_t *)arg)->x = x;
+ ((u8g_dev_arg_pixel_t *)arg)->y = y;
+ ((u8g_dev_arg_pixel_t *)arg)->dir+=3;
+ ((u8g_dev_arg_pixel_t *)arg)->dir &= 3;
+ }
+ u8g_call_dev_fn(u8g, rotation_chain, msg, arg);
+ break;
+ }
+ return 1;
+}
+
+